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ABSTRACT 



The objective of this analytical study was to develop an optimal 
emitter location algorithm using Kalman filtering techniques to filter 
emitter bearing angles -of-arrival information in an airborne, multi - 
emitter environment. Since emitter and aircraft navigation data were 
sampled at discrete time intervals, discrete sequential estimation 
techniques were utilized within a software computer program which 
initially sorted data, filtered emitter bearing angles -of --arrival to 
obtain optimal estimates, and computed emitter positions in latitude/ 
longitude coordinates using various emitter location algorithms. An 
error analysis v/as performed on the emitter location algorithms to 
determine relative accuracy of the different techniques. Extended 
Kalman filtering was also considered as an alternate approach to the 
emitter location algorithm. 
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I. INTRODUCTION 



One goal of airborne direction-finding (DF) is to obtain the 
location of an electromagnetic radiation source in latitude /longitude 
coordinates on the earth's surface. Over the years many emitter 
location techniques have been devised, and much research has been 
devoted to optimizing bearing angle measurements in angle-only 
direction-finding and navigation systems. Much of the effort has been 
directed toward physical components such as the directional receiving 
antenna and the improvement of its characteristics. In airborne DF 
systems current typical bearing angle -of- arrival (AOA) accuracy is 
found to be about + 2® at microwave frequencies. Despite such 
accuracy a multiple bearing fix will yield considerable emitter position 
ambiguity at any significant range between the emitter and the airborne 
DF system. 

To improve this situation a statistical optimal estimate of each 
received emitter bearing angle was computed using sequential estima- 
tion techniques, commonly called Kalman filtering. Additionally, an 
adaptive gating technique was utilized which selectively filtered out 
bearing lines which did not closely associate with other bearing lines 
already filtered and correlated to a distinct emitter location. Smooth- 
ing techniques were utilized to improve the unfiltered initial bearing 
angle, and a smootlied initial bearing angle and filtered final bearing 
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angle were used in a spherical earth triangulation solution to estimate 
the emitter position. The entire sorting, filtering, smoothing, gating, 
and triangulation procedure was organized within a software computer 
program capable of automatically estimating multiple emitter locations 
given noisy emitter bearing angle data and aircraft navigation data. 
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II. ANALYSIS OF THE PROBLEM 



A. APPLICATION 

The objective of this analytical study was to develop an optimal 
emitter location algorithm which would have application to military 
aircraft flights in an operational environment. The computer program 
developed could be utilized in an airborne digital computer system to 
give real-time analysis of emitter parameters in a multiple emitter 
environment, or it could be used in a ground-based computer system 
to give post-flight analysis of large quantities of compiled data. 

Since all data sampling and processing was done at discrete time 
intervals, discrete sequential estimation techniques were utilized. 

The real facility in using sequential estimation techniques is that each 
subsequent computation is based only on the new observation and the 
last previously calculated estimate, and these recursive equation com- 
putations require a minimum of computer storage to filter a large 
quantity of data. This makes such an emitter location algorithm ideal 
for airborne computer application [1]. 

To allow generality of application, the software system was 
developed to process multiple emitter locations, to sort and filter 
large quantities of emitter data, to filter data at non-uniform sampling 
intervals, and to estimate emitter locations on any region of the earth's 
surface. It was initially assumed that no errors existed in the aircraft 
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navigation data; hence these position data together with two or more 
filtered emitter bearing angles could be used to compute the emitter 
location (see Figure 1). If a deterministic aircraft navigation error 
was known to exist, it could be compensated for in the emitter location 
algorithm. If a random error existed in the aircraft navigation data, 
it could be minimized by using a non-zero Q matrix to account for 
random excitation noise (see Section III, Part B, page 17) or by Kal- 
man filtering the aircraft navigation data as well as the emitter bear- 
ing data. Kalman filtering techniques have also been developed to 
optimize navigation system accuracy [2]. 




FIGURE 1 

GEOMETRY OF EMITTER LOCATION 
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B. KALMAN FILTER UTILIZATION 

A signal X, measured in the presence of random white Gaussian 
noise V, is filtered in an attempt to recover the original signal. The 
filtered estimate of the state is denoted by X. From Kalman filter 
theory [3] for discrete systems using first-order difference equations, 
the kth noisy observation Z(k) of the state is given by 

^(k) =_H(k)X(k) + V(k) k = 1, 2, 3, . . . (1) 

where H(k) is the observation matrix and V(k) is the measurement 
noise. Since a discrete or sampled system is being considered, k 
denotes the kth time sample. 

The state of a general, discrete system with no deterministic 
forcing function is given by 

X(k+1) = _^(k+l,k)2C(k) + r_W(k) k = 1, 2, . . (2) 

where $(k+l,k) is the state transition matrix, _T^ is a distribution 
matrix related to the random forcing function, and W(k) is a random 
forcing function to account for random excitation noise. It was 
assumed that the noise sequences have zero mean and second-order 
statistics described by 

E[^y(k)V(j)'^j = R_(k)S(kj) (3) 

£_E[^W(k)W(j)^]X.'^ = Q(k)S(kj) (4) 

and Ej^V(k)W(j)^j = 0 forallk,j (5) 
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where 



is the Kronecker delta. 



S (kj ) 



f 0 k;«j 

' 1 k=j 



The Kalman filter recursion equations [1] are summarized 
below where X(k/j) denotes the estimate of the state X(k) based upon j 
measurement observations Z(l), Z(2), . , Z(j). 

G(k) = P(k/k-l)H(k)'^j^H(k)P(k/k-l)H(k)'^ +R(k)j"^ 

P(k/k) = P(k/k-l) - G(k)H(k)P(k/k-l) 

P(k+l/k) = _^(k+l,k)P(k/k)_^(k+l,k)'r + Q(k) 

X(k/k) = X(k/k-l) + G(k)[^Z(k) - H(k)X(k/k- 1)J 



X(k/k-l) = (J)(k, k-l)X(k-l/k-l) 



( 6 ) 

(7) 

(8) 
(9) 

(10) 



The Kalman filter gains are represented by the matrix G(k), and 
P(k/j) represents the error covariance matrix of the various estimates. 

For the problem being considered the states are bearing angle - 
of-arrival and bearing rate, and it is desired to filter the noisy 
observed bearing angles to obtain optimal estimates of these states. 

The system dynamics were approximated by a 1/s^ plant which results 
in a state transition matrix given by 



^(k+l,k) 



1 T(k+1) 

0 1 



Since only the bearing angle of the state was observed, R(k) and W(k) 
become scalar variance terms and the bracketed terms in equations 
(6) and (9) become scalars as well. This considerably simplified 
reducing these matrix equations to scalar form (see Appendix A); 
however, allowing a non-uniform sampling interval required that the 
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term T(k+1) remain a variable in each of the applicable recursion equa- 
tions. This required that error covariance terms and Kalman filter 
gains be computed on line since they were a function of the sampling 
interval; therefore, these terms could not be precomputed and stored. 

Several assumptions are implicit here. Modeling the system 
dynamics with a l/s^ transfer function gives a linear approximation 
that may not adequately represent the actual system equations, which 
are non-linear [4]. It may then become necessary to augment the 
dynamic model with an additional difference equation which includes 
the second derivative of the measured bearing angle, or extended 
Kalman filtering techniques may be employed to more accurately 
approach the non-linearity of the dynamic system. Extended Kalman 
filtering techniques are discussed in Section III, Part F, of this paper. 

The statistical nature of Kalman filtering techniques requires 
that the statistics of the measurement noise V(k) and the excitation 
noise W(k) be completely specified, or if unknown they must be 
assumed. If no deterministic errors are known to be coloring these 
noise sources, the assumption of white noise may be a good one al- 
though it may not exactly model the actual noise bearing error. Kal- 
man filtering assumes that the noise is independent from one sampling 
interval to the next [5]. This may not be an accurate assumption since 
successive bearing angle observations from a single emitter might 
have similar error statistics. Any deterministic bias in aircraft 
antenna bearing angle-of-arrival measurement would further negate 
this assumption. This difficulty was reported by Reeves [6], who recom 
mended that emitter bearing angle-of-arrival measurement noise be 



considered to have both random and correlated components. This 
would require augmenting the state vector equation with an additional 
variable and further complicate the Kalman filtering process. 

C. SMOOTHING TECHNIQUES 

Since Kalman filtering techniques sequentially filter the second 
and subsequent bearing angle observations associated with a single 
emitter, the first bearing angle associated with a particular emitter 
remains unfiltered and no optimal estimate exists. Thus a technique 
of filtering backward in time or smoothing was used to improve the 
estimate of the initial bearing angle. The smoothing equations are 
similar to Kalman filter equations in that they are recursive and 
functions of similar statistical parameters, but they update or smooth 
previous data based on more recent data that has been optimally 
estimated. 

A general technique proposed by Rauch [7] gives the smoothed 
estimate of the initial observation after k time intervals as 

X(l/k) = ${l/k-l) + p(l/k)G(k)j^Z(k) - H(k)X(k/k-l)] (11) 

where D(l/k) = p(l/k-l)P(k-l/k-l)^(k, k-l)'^P(k/k-l)7^ (12) 

For a non-uniform sampling interval D(l/k) becomes a function of 
T(k) and must be solved sequentially before the smoothed initial 
estimate X(l/k) can be computed. For an analysis of these equations 
reduced to scalar form, see Appendix B. These scalar smoothing 
equations were included in the software computei’ program and yielded 

a smoothed estimate of the initial bearing angle and bearing rate. 
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III. COMPUTATIONAL PROCEDURE 



A. INITIAL DATA SORT 

The problem was posed to accommodate a realistic airborne 
environment with multiple emitters at various RF frequencies, emitter 
bearing angle-of-arrival errors, and a constant velocity moving air- 
craft. Aircraft navigation and emitter target data was sampled and 
recorded at discrete but time- varying intervals. Since the number of 
emitters was unknown and large quantitites of signal data were recorded 
at various frequencies, pulse repetition frequencies (PRF), and pulse 
widths (PW), it was necessary that the data be initially sorted by fre- 
quency and PRF to initially estimate the number of distinct emitter 
targets. This was accomplished with sufficiently small frequency and 
PRF gates to separate and associate emitter parameters with a distinct 
emitter target. Additionally, it was found that multiples of PRF may 
exist which associate with a single emitter, so a check for PRF multi- 
ples had to be included within the PRF sorting subroutine. One set of 
data processed by this program included PRF multiples given on page 59. 

Multiple emitters of the same frequency and PRF could still 
result in an ambiguous solution; therefore, each bearing angle initially 
associated with a distinct emitter by the initial data sort was sequen- 
tially filtered and gated to determine if it correlated with this emitter. 
Due to the large quantity of data to be processed, any bearing angle not 
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correlated to a distinct emitter after being filtered and gated was dis- 
carded from the data bank. Further investigation and greater computer 
storage capability could allow such discarded bearing angles to be re- 
associated with a different emitter; however, this process was not 
developed within this analysis. 

B. KALMAN FILTER INITIALIZATION 

Initialization of the Kalman filter equations requires a knowledge 
of the system dynamics, the statistical properties of the Kalman filter 
parameters, and some information about the initial state of the system. 
Since it was necessary to associate each sorted data sample (emitter 
bearing angle and associated emitter data) with a particular emitter, 
the notation JSET (I, J) was devised, where I is the emitter target 
number with which the data sample is associated and J is the jth sample 
of sequential data associated with that emitter. JSET(I, J) gives the 
sequential sample number for this data sample when listed together 
with all other data. See page 63 for a listing of initial JSET data. To 
initialize the Kalman filter equations, KI was used as the initial JSET 
value; i.e., JSET(I, 1) = KI for the ith emitter target. 

To filter emitter bearing angles-of-arrival, the noisy observation 
of the state from equation (1) is given by 

6(k) = mk)_0(k) + V(k) (13) 
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where 



0(k) 



0(k) = 



0(k) 



®(k) = 



®(k) 

®{k) 



= vector of noisy measured observations. 



= state vector of exact emitter bearing angle 



and bearing rate, and H(k) = [l 0 ] is the observation matrix for 
measurement of only noisy bearing angle 0 . Since the bearing rate 
0 (k) was not measured, it must be estimated to initialize the sequen- 
tial estimation process. This bearing rate depends on the speed and 
heading of the aircraft with respect to the emitter, the relative bearing 
angle-of-arrival, and the range r to the emitter. Since the range to an 
unknown emitter is unknown, it must be estimated. For this program 
r = 150 nautical miles was assumed and 



0(KI) - ^sin(BRNG) x degrees/second (14) 

^ 3600 

where BRNG = relative bearing angle-of-arrival 
PIRAD = 57.29578 degrees/radian 
V = aircraft velocity in knots. 

If an estimated value of range to the emitter is known and different 
from 150 nautical miles, then this new value should be used in 
equation (14) and substituted into the computer program. 

Since an initial optimal estimate was not available to the filtering 
process described by equations (9) and (10), the first bearing angle 
optimal estimate THTD(KI) was assumed equal to the noisy measured 
bearing angle THETAD(KI), and the first bearing rate estimate TDTD(KI) 
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was assumed equivalent to 0(KI). The smoothing process was simi- 
larly initialized. 

The initial uncertainty of emitter bearing angle and angle rate on 
filter initialization was accounted for in the initial values of the error 
covariance matrix P(l/0). Since stationary emitter locations were 
considered, the random forcing function W(k) of the dynamic state 
equation (2) could be set to zero if exact knowledge of the observer's 
aircraft position were known. However, since the aircraft position 
may have both random and deterministic errors associated with its 
position measurement and because of the simplified matrix, a non- 
zero Q matrix was utilized. For W(k) having a zero mean and 
Erw(k)^l = 1.0 degrees^ from equation (4) 




rT^(k) 

4 

T^(k) 

2 



T^(k)-| 

2 

T^(k) 



(15) 



The value of R(k), the scalar variance of the measurement noise, 
was assumed to be constant and estimated according to the angle meas- 
urement accuracy of the DF system being considered. The initial D 
matrix for the sequential smoothing process was initialized as the 
identity matrix (see Appendix B). 

When utilizing this program for emitter location with different 
known measurement and covariance statistics, these initialization 
parameters must be changed in the computer program to ensure optimal 
solution locations. The only other term which must be modified by the 
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program user is the value of NUM, whicli is the total number of data 
samples to be sorted and filtered by this program. Since the data for 
each emitter must be filtered separately, the filter process occurs 
once for each distinct emitter target as determined by the initial data 
sort. Once an optimal estimate of emitter bearing angle and bearing 
rate have been initialized, the filter process is ready to commence, 

C. KALMAN FILTER PROCESS 

The Kalman filter equations utilized to filter the states, emitter 
bearing angle 0 and bearing rate 0 , are those noted on page 11 shown as 
equations (6) through (10) with X I'eplaced by 0 . Since these are vector 
equations and tedious to handle within a computer program, their 
scalar counterparts were derived (see Appendix A) and utilized within 
the program. The optimal estimation equation is similar to equations 
(9) and (10) and is given by 





’'0'(k/k)' 




1 T(k)' 




’ 0'(k-l/k-l) 




'Gl(k) 






0(k/k) 




0 1 




e^(k-i/k-i) 


4 - 


G2(k) 


E(k) (16) 


where 


E(k) 


= 0(k) - ^(k- 


1/k-l) - T(k)0(k-l/k-l) 


(17) 



results in a scalar term since only one of the state variables was 
measured. 

Due to the non-uniform sampling interval, the Kalman filter gains 
Gl(k) and G2(k) may vary and not approach a steady state value at a 
uniform rate as they would with a constant sampling interval. This is 
shown graphically in Figure 2, which depicts the transient Kalman ' 
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FIGURE 2 



KALMAN FILTER GAIN SCHEDULE 
FOR A NON-UNIFORM SAMPLING INTERVAL 
KALMAN FILTER PROCESS 
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1. Points plotted above represent 'discrete values of Kalman'filter gain 
G1(K) associated with filtering the bearing angle of the state vector. 

2. Since the prediction covariance matrix (P(k+l/k) given by equation (8) 
is a function of <5>(k+l,k), which contains the sampling interval T(k+1), 

it can be seen that the Kalman filter gain G(k) will also vary with T(k+1) 
as in equation (6). As the sampling interval increases, the gain will also 
increase. 
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FIGURE 3 



KALMAN FILTER GAIN SCHEDULE 
FOR A UNIFORM SAMPLING INTERVAL 
KALMAN FILTER PROCESS 
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NOTES: 

1. Points plotted above represent discrete values of Kalman filter gain G1(K) 
associated with filtering the bearing angle of the state vector. 

2. After ten sampling intervals the gain has nearly reached a steady state 
value of 0.417. This asymptote is determined by the non-zero value of the 
Q matrix. 

3.. If system random excitation noise (i. e. , the Q matrix) were assumed 
to be zero, then the Kalman filter gain would approach zero upon reaching 
steady state. 
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filter gain schedule of a non-uniform sampling interval. B'igure 3 
shows the Kalman filter gain schedule of a uniform, twelve-second 
sampling interval computer simulation, which was developed to allow 
an error analysis to be made on the Kalman filter program. 

The adaptive gate was chosen to be a function of the prediction 
variance term Pll(k/k-l), which is a Variable function, and the 
measurement noise variance R(k), which is constant. The adaptive 
gate was set to selectively compare the filtered bearing angle with 
previously correlated bearing angles. If a filtered bearing does not 
fall within the adaptive’ gate, it is discarded and the sampling interval 
increases to the last previous correlated bearing. This increases the 
Kalman filter gain and opens the adaptive gate to a wider allowable 
value until a subsequent bearing angle is found which correlates to this 
emitter, then causing the adaptive gate to reduce in size. The adaptive 
gate was chosen to be 

GATE(K) = ^ ^ Pll{k)+R(K) 

where C is a constant scale factor. Since the prediction covariance 
P(k/k-l) may be defined as 

P(k/k-l) = E I |^^{k) - _6(k/k-l) j j^^(k) - _0_(k/k-l)j | , (IS) 

which is a function of the mean square error between the true value of 
the bearing angle and its optimal estimate, it can be seen that as the 
estimate error increases the adaptive gate will increase and as the 
optimal estimate approaches the true value the gate size will decrease 
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as is desired. The constant term R(k) prevents the gate from getting 
so narrow that no emitter bearing angles could correlate to a distinct 
emitter, and the variable term Pll(k) allows the gate size to "adapt" 
to the transient filter errors as was noted above. 



D. INITIAL BEARING ANGLE SMOOTHING PROCESS 



In order to obtain a smoothed estimate of the first bearing angle 
associated with each emitter target, it was necessary to solve equation 
(11) sequentially within the Kalman filter process since the gain term 
was recomputed after each sampling interval. The smoothed initial 
bearing angle estimation equation used in the software program is 
similar to equation (11) and is given by 



'^(1/k)' 




0(l/k-l) 




Dll(l/k) D12(l/k) 




GKk)" 






- 












E(k), (20) 


0(l/k) 




0(l/k-l) 




D21(l/k) D22(l/k) 




G2(k) 
L J 





where E(k) is defined by equation (17) and the scalar terms in the D 
matrix are as derived in Appendix B. To compute these terms, both 
4^(k, k-l)~^ and P(k/k-l)“^ had to be determined. The inverse of the 
state transition matrix is obviously given by 



<I>(k,k-l)-l = 



1 -T(k) 

0 1 



( 21 ) 



Should the error covariance matrix become singular because of numer- 
ical inaccuracy in computation, no inverse will exist. In this case 
corrective action must be taken before attempting to compute the 
inverse. Several references have discussed this problem, suggested 
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solutions, and Schmidt [8] gives a survey of current techniques in this 
area. For this program, the IBM 360 subroutine MINV was utilized to 
compute the error covariance matrix inverse with good numerical 
accuracy. 



E. EMITTER LOCATION ALGORITHMS 

Several techniques were investigated to obtain a computationally 
simple yet accurate algorithm to calculate the emitter locations. Since 
more than two bearing lines may result in an ambiguous emitter loca- 
tion, it was most logical to use only the smoothed initial bearing angle 
/\ /\ 

0j[ and the filtered final bearing angle 0£ to compute the location. Any 
such location procedure would give most accurate results if the two 
bearings intersected at right angles; however, infrequent data collec- 
tion, short-leg flight tracks, or long-range distances from the emitter 
generally prevent such choice of initial and final bearing angles. 

1. Plane Triangulation Solution 

The basic "flat earth" triangulation solution was presented 
by Kayton and Fried [9] and discussed in some detail in Refs. 6 and 10. 
Figure 1 depicts the geometry of the triangulation method of emitter 
location solution, and the solution equations are given by 



^ _ Xj 



tan = 



and 



tan 0 



^ _ Xf 



Yt- Yf 



( 22 ) 



(23) 



where the emitter location coordinates (Xrp, Yrp) are unknown and must 
be determined. 
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If latitude (L)/longitude (X) coordinates are substituted for 
the X/Y axes in the flat earth model, the following equations result: 

(Xrr -XJcosL,„ 



tan 0 - 



( 24 ) 



tan0£ = 



L-p - Lj 



(X^ -Xf)cosL^ 
Lt - Lf 



( 25 ) 



These equations, gave a more accurate solution but were more complex 
to program since one of the unknowns (L,p) occurs both as an explicit 
function and as a cosine function. This difficulty was resolved by 
solving for an intermediate value of emitter latitude (TILA) based on an 
aircraft midlatitude cosine function (WAV) which was known and then by 
recomputing emitter latitude (TLA) based on the cosine function of the 
intermediate emitter latitude. The resulting equations are given by 



L. + L. 
1 f 



WAV = 



TILA = 



/N 



(X^ - X-.)cos(WAV) + L.tan0. - 
f 1 1 ''i 

_ ^ 

taii0£ - tan0f 



/N 

L^tan0^ 



( 26 ) 



( 27 ) 



TLA 



(Xf -Xi)cos(TILA) + L.tan^^ - L^tan'§'^ 



tan"§i - tan^£ 






TLO = Xf - (L.J, - L^tan0j/cos(TILA) 



( 28 ) 



( 29 ) 



where TLA = emitter target latitude Lrp 
TLO = emitter target longitude Xp 
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L- = initial aircraft position latitude 

Xj = initial aircraft position longitude 
= final aircraft position latitude 

Xf = final aircraft position longitude. 

These equations are derived in Appendix C and are equivalent to the 
"round world" model developed on pages 41-43 of Ref. 6. 

2. Spherical Triangulation Solution 

Two approaches to a spherical earth solution were taken. 

The first involved the derivation of a spherical triangulation solution 
with two equations resulting from two spherical triangles as shown in 
Fig. 4. These equations are derived in Appendix D and are given by 

tan I (X^ - X.)cosL I 

tane^i = (30) 

sin(Lrj, - Lp 

^ tan (Xrp - X-.)cosL 

tan0£ = = . (31) 

sin(L^ - L^) 

These equations represent exact solutions for emitter loca- 
tion on a spherical earth of constant radius. It is known that the earth 
is an oblate spheroid so small errors may be introduced at large dis- 
tances from the emitter with such a spherical earth solution. However, 
according to Kayton and Fried [9], a constant radius of curvature can be 
used everywhere on the earth with an error of less than 0.2 percent of 
distance. 

If the emitter location problem is concerned only with micro- 
wave frequency emitters, then relatively short distances from the 
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FIGURE 4 



SPHERICAL EARTH TRIANGULATION SOLUTION 
FOR EMITTER LOCATION 




FIGURE 4a 




TRIANGLE FIGURE 4c 

FINAL SPHERICAL 
TRIANGLE 
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aircraft to the emitter v/ill exist since microwave electromagnetic 
(EM) energy propagation approximates a straight line path (line-of- 
sight) on the earth's surface. Reintjes and Coate [11] show that the 
maximum distance for direct EM wave propagation to a radar horizon 
is given by 



assuming a 4/3 effective radius of the earth for standard EM energy 
refraction characteristics. If h^ is unknown or assumed to be zero, 
then aircraft altitudes (h^) up to 80, 000 feet should not yield radar 
horizons greater than 400 statute miles (350 nautical miles). At this 
distance latitude /longitude differences between the aircraft and emitter 
are small (less than 6°), and it can be seen that the emitter location 
algorithm developed from equations (24) and (25) is nearly equivalent 
to the exact spherical solution from equations (30) and (31) since the 
tangent and sine functions of small angles are approximately equal to 
the radian measure of the angles themselves. Thus for ranges up to 
360 nautical miles from the emitter, the planar solution will be less 
than 0, 5 percent in error from the spherical solution. For ranges of 
less than 150 nautical miles the error may be neglected and the plane 
triangulation solution may be considered sufficiently accurate for 
emitter location estimation. 




(32) 



where d = radar horizon in statute miles 



ha = aircraft altitude in feet 



hg = emitter altitude in feet 
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If greater accuracy is desired, the spherical triangulation 
equations (30) and (31) may be solved by an iterative procedure as 
suggested in Appendix E. It was found to be tedious to attempt a 
closed-form solution. 

3. Earth-Centered Coordinate System Solution 

Another approach to the spherical earth solution was con- 
sidered using tangent plane projections and an earth-centered coordi- 
nate system (x^, x^jX^), where the x^ axis is the polar axis and the Xj^, 
X 2 plane is the equatorial plane of the earth. An observation plane was 
defined for each emitter-bearing line, which passed through the center 
of the earth and inscribed a great circle arc on the earth's surface 
between the aircraft and emitter positions. The procedure for obtain- 
ing the emitter location required solving the equations of the observa- 
tion planes, two at a time, with a constraint equation that the emitter 
be located on the earth's surface. Assuming a constant earth radius 
and letting x^ equal a constant, the emitter position may be computed 
from the equations of the plane c) where x^ = constant as shown 

below. 

^ 11^1 ^ 12^2 ^ "^ 13 ^ 

^ 21^1 ^ 22^2 ~ "^ 23 ^ 

These equations were then transformed back to the original 
coordinate set (xj,X 2 ,x ) by the equation 

x^ = Ax^ i = 1, 2, 3. (35) 
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where 



(36) 



2 2 2 A 

A = Re/{xj + X2 + c)^ 

and Re = average radius of the earth. 

With proper coordinate rotation, it is possible to have the projection 

plane (xg = c) tangent to the earth's surface and centered at the aircraft 

observation position. 

F. EXTENDED KALMAN FILTERING 

It may be desirable to directly filter and update the estimates of 
emitter position (L,p, X,p) as described by Reeves [6]. If only bearing 
angle -of- arrival information is available as observable data, however, 
a non-linear transformation must be utilized to transform observable 
bearing angles into filtered position estimates. 

This was accomplished by extended Kalman filtering techniques 
utilizing the concepts of small perturbation theory and a Taylor series 
expansion about an initial point. Equation (1) then becomes 

^(k) = N[^X(k)] +V(k) (37) 

where Z(k) represents the observable bearing angles, X(k) is the 
emitter position vector, and N represents the non-linear transforma- 
tion given by 

^ -i/<V ■ 

0 = tan"( 1 _] . (38) 

y L.p - L J 

If the position error of the state vector X(k) is given by 

X(k) = X(k) - X(k) , (39) 

then the true position X{k) may be expanded about the most recent 

/N 

optimal estimate X(k) in a Taylor series expansion with higher order 
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(40) 



terms neglected as shov/n below: 



where 



M(k) = 



N 


[x(k)j + 


M(k)X 




A 


A 




r ae 


1 


A 

X 


Uxt 





4 - 



(41) 



for the emitter location algorithm given by equations (24) and (25). 

The Kalman filter recursion equations (6) through (8) may then be 
rewritten to account for this non-linear observation matrix and are 
given by 

G(k) = P(k/k-l)M(k)'^ J^M(k)P(k/k-l)M(k)'^ + R(k) j (42) 

P(k/k) = P(k/k-l) - G(k)M(k)P(k/k-l) (43) 

P(k+l/k) = _^(k+l.k)P(k/k)^(k+l,k)'T + Q(k) . (44) 

Since the non-linear filter is processing estimates of a stationary 
emitter position, the matrix becomes the identity matrix and the 
equations are considerably simplified and reduced to scalar form 
(see Appendix F). 

The greatest difficulty in this approach was found in initialization 
of the extended Kalman filter process. Errors or inaccuracies in 
initialization may cause the recursive computations to diverge, and it 
was therefore decided to commence extended Kalman filter processing 
only after linear filtering and smoothing of the bearing angle observa- 
tions had been completed and an initial optimal estimate of emitter 
position obtained. This would allow the extended Kalman filter process 
to be used as a final correction procedure to further improve the final 
optimal estimates of emitter position. 
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IV. PRESENTATION OF RESULTS 



A. MONTE CARLO SIMULATION ANALYSIS 

Since this Kalman filter program was developed to process actual 
aircraft flight data, a Monte Carlo simulation was utilized to accom- 
plish program validity checks and error analysis studies. Figure 5 
depicts the geometry of the simulation with an aircraft flying due south 
at 600 knots off the coast of southern California. Tv/o VORTAC stations 
were chosen as emitters with accurately known positions given as 



EMITTER //I 


Oceanside VORTAC 


33.24055®N 




Channel 100 


-117. 41694®W 


EMITTER #2 


Frequency 1197 mUz 
San Diego VORTAC 


32. 78222°N 




Channel 125 


-117.22444®W. 




Frequency 1212 mHz 





Bearing angle -of- arrival information was assumed to arrive every six 
seconds alternately from each target giving a twelve -second uniform 
sampling interval for simplicity. Known true bearing angles were 
computed numerically in the absence of measurement noise and allowed 
position location within twenty feet of the known locations given above. 

In the presence of computer-generated random measurement 
noise of one degree variance, a large number of simulation runs were 
executed to obtain a statistically valid error analysis. The results of 
tills analysis are given in Appendix G and summarized below for the 
two simulation emitters. A range error was computed from each 
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PLOT OF MONTE CARLO SIMULATION AIRCRAFT TRACK 
AND EMITTER BEAl^ING ANGLES-OF-ARRIVAL 



position estimation latitude and longitude error, and all errors were 
statistically averaged for the total number of runs. 



MONTE CARLO SIMULATION ERROR ANALYSIS 
average error in nautical miles 



normalized 



emitter 


average 

latitude 

error 


average 

longitude 

error 


average 

range 

error 


closest 
point of 
approach 


estimated 
position 
range error 


1 


0.44852 


0.23376 


0. 53692 


54. 5 


0. 985% 


2 


0. 39961 


0.23108 


0. 50758 


64. 7 


0. 785% 



These results show that the basic plane triangulation solution emitter 
location algorithm is capable of estimating position within one percent 
of range at emitter distances of less than 100 nautical miles. 

B. AIRCRAFT FLIGHT DATA ANALYSIS 

The Kalman filter program was also utilized to process and filter 
aircraft flight data of the form discussed in Section III, Part A, of this 
paper. This data processing tested maximum utility of the computer 
program since certain data samples would not correlate with predicted 
emitter locations and had to be selectively gated out. Figures G through 
10 show graphs of noisy unfiltered bearing angle -of- arrival information 
initially associated with a distinct emitter tai-get. The dotted lines show 
unfiltered bearing angles and the solid lines show the smoothed initial 
and filtered final bearing angle. It can be seen that Figures 7, 9, and 
10 have erroneous bearing angles which must be excluded from the 
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Kalman filtering process by the adaptive gating technique. This is 
shown to occur in the results of the computer output on page 64. Also 
comparing the final JSET data (page 65) with the initial JSET data 
(page 63 ) shows which data samples were not correlated to a distinct 
emitter target and were discarded. 

The emitter location estimation accuracy obtained from the 
results of processing and filtering flight data was not as good as that 
obtained from the Monte Carlo simulation; however, it was estimated 
that the standard deviation of bearing angle measurement noise was 
approximately 12® and that some aircraft navigation error may have 
existed as well. Therefore, typical emitter location estimation within 
3 percent on an average range from aircraft to emitter target of 100 
nautical miles was considered reasonable. 
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FIGURE 6 



PLOT OF NOISY MEASURED BEARING ANGLES 
ASSOCIATED WITH EMITTER TARGET 
NTAR = 1 



36.67 




35.90 




35.12 



NORTH 

LATITUDE 



-- 34.35 



IN 

DEGREES 

33.57 



-- 32.80 






122.68 



1 i 1 1 

-121.75 -120.83 -119.90 -118.98 

WEST LONGITUDE IN DEGREES 



I |_ 32.03 

-118.05 -117.13 
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FIGURE 7 



PLOT OF NOISY MEASURED BEARING ANGLES 
ASSOCIATED WITH EMITTER TARGET 




WEST LONGITUDE IN DEGREES 
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FIGURE 8 



PLOT OF NOISY MEASURED BEARING ANGLES 
ASSOCIATED WITH EMITTER TARGET 




WEST LONGITUDE IN DEGREES 
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FIGURE 9 



PLOT OF NOISY MEASURED BEARING ANGLES 
ASSOCIATED WITH EMITTER- TARGET 
NTAR = 4 




WEST LONGITUDE IN DEGREES 
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FIGURE 10 



PLOT OF NOISY MEASURED BEARING ANGLES 
ASSOCIATED WITH EMITTER TARGET 




WEST LONGITUDE IN DEGREES 



39 



I 




V. CONCLUSIONS 



It was found that Kalman filtering techniques have useful applica- 
tion in the field of airborne direction-finding and emitter location pro- 
cedures. Many airborne directional antenna receiving systems have 
+10® typical bearing accuracies which yield poor results in conven- 
tional plotting and triangulation procedures for emitter position fixing. 
The Kalman filtering process, in effect, statistically filters out random 
signal error or measurement noise, resulting in an optimal estimate of 
the true signal. 

By computer processing techniques these emitter data may be 
sorted and sequentially filtered to yield optimal estimates of bearing 
angle -of -arrival Information. Computerized solutions, as suggested 
within this paper, may then be utilized to compute numerical emitter 
locations in latitude /longitude coordinates to a high degree of accuracy. 
For limited -storage airborne computer applications the Kalman filter- 
ing process and plane triangulation solution should be readily adaptable 
to airborne implementation to yield real-time cockpit display outputs 
with typical estimated emitter position error within three percent of 
the exact value. 

For more precise resolution of emitter location, the spherical 
earth triangulation solution may be considered; or alternately, the 
extended Kalman filtering techniques may be utilized to improve or 
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update plane triangulation solution initial estimates of emitter location. 
These procedures are somewhat more involved, however, and would 
require greater computer memory and processing time. 
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APPENDIX A 



DERIVATION OF SCALAR KALMAN FILTER 
RECURSION EQUATIONS 



The Kalman filter recursion equations from page 11, equations 
(6), (7), and (8), are listed below: 

G(k) = P(k/k-l)H(k)T j^H(k)P(k/k-l)H(k)'^ +R(k)J"^ (lA) 

P(k/k) =JP(k/k-l) - G(k)H(k)P(k/k-l) (2A) 

P(k+1 /k) = ^(k+1, k)P(k/k)^(k+l, k)"^ + Q(k) (3A) 

where in this application ^ (k+1, k) = ^ T(k+1)^^ 

H(k) =1^1 o] , 

the P and^ matrices may be considered to have scalar components 
given by 

1 P12l fQll Q12^ 

respectively, 

G1 
G2 



■pil P12‘ 




’qii 


Q12^ 




and 






P21 P22 




Q21 


Q22 



and the G matrix is a 2x1 matrix of the form 



Writing equation (lA) in matrix notation yields 



G1 

G2 



Pll P12 
P21 P22 



n 

0 



[l o] 



Pll P12 
P21 P22 



+ R 



-1 



; (4A) 



and for the observation matrix H(k) fhe inverse term becomeJ 

a scalar allowing the gain terms to be computed directly, as is shown 
below: 
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(5A) 



'Gf 


1 


'pll' 


r 




= 




Pll + R 


1 

o 

CO 

1 




P21 


L J 



which results in the scalar gain equations 



Pll(k/k-l) (6A) 



Pll(k/k-l) + R(k) 



P21(k/k-l) 

G2(k) = ; — • (7A) 

Pll(k/k-l) + R(k) 



From equation (19) which defines the P matrix, it can be seen that since 
^ 'j' 

0 arid 0 are statistically independent, where 

~ _ /N 

0 = 8 " 0 • 



then P12 = P21, and the P matrix is symmetric. From equation (15) it 
can be seen that the Q matrix is also symmetric. Equation (7A) then 
becomes 



G2(k) = 

Pll(k/k-l) + R(k) 



(8A) 



To solve for the prediction covariance scalar terms, equation 
(2A) was substituted into (3A) giving 











_ 


' 








_ 








\ 








— 


Pll 


P12 


- 


1 


T 




Pll 


P12 




G1 


[lo] 


Pll 


P12 




1 0 


+ 


Qll 


Q12 


P12 


P22 




0 


1 




P12 


P22 

J 


1 


G2 


P12 


P22 




T 1 




Q12 


Q22 



k+l/k k/k-1 k/k-1 



which upon simplifying and writing in scalar form yields equations as 
noted on page 84 of the Kalman filter program. 
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APPENDIX B 



DERIVATION OF SCALAR SMOOTHING EQUATIONS 



The general smoothing equations (11) and (12) are given on page 
13 and are repeated below: 



X(l/k) = X(l/k-l) + D(l/k)G(k)E(k) (IB) 

where D(l/k) = D(l/k-l)P(k-l/k-l)_^(k, k-l)Tp(k/k-l)"^ (2B) 

and E(k) = Z(k) - H(k)X(k/k-l) . (3B) 

A 

In order to solve for a smoothed value of the state X(l/k), it is first 
necessary to solve equation (2B) sequentially since the state transition 
matrix is a function of the variable sampling interval as given by 



(I)(k.k-1)'^ 



1 o' 

T(k) 1 



(4B) 



It is also necessary to obtain the inverse of the error covariance matrix 
P in order to solve equation (2B). On the IBM 360, the matrix inverse 
routine MINV was used with good numerical accuracy, and the results 
were programmed as follows: 





Vii 


P12 ^ 


-1 


PINll 


PINI2' 






= 








P21 


P22 

J 




PIN21 


PIN22 



(5B) 



and letting 
P 



Pll 


PI2' 


, D = 


Dll 


DI2' 


, and Q = 


Qll 


QI2" 


P21 


P22 




D21 


D22 




Q21 


Q22 
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as before. Since the P matrix is symmetric (as shown in Appendix A), 
P”^ is also symmetric. 

To solve for the scalar smoothing equations, equation. (8) on page 
11 was solved for P(k-l/k-l) giving 

P(k-l/k-l) = ^(k,k-l)'^[p(k/k-l) - Q(k)j^^ (k,k-l)"^ . (6B) 

This equation was then substituted into equation (2B) giving 

p(l/k) = p(l/k-l)_^(k,k-l)"^ rp(k/k-l) - Q(k)l_P(k/k-l)'^ , (7B) 



which written in matrix form yields 



Dll 


D12 




Dll 


D12 




D21 


D22 




D21 


D22 






1/k 




1/k 







r— 




D 


Qll 


Q12 




PINll 


PIN12 


ij 


p|12 


Q22_^ 


1 


PIN12 


PIN22 



This reduces to 



"01 1 DI2" 




Dll D12~ 




~i -t" 




1.0 - QPll -QP12 


D21 D22 




D21 D22_ 




0 1 




-QP21 1.0 - QP22^ 




/k 


1/1 


k-1 





where QPll = Qll(PINll) + Q12(PIN12) 
QP12 = Q1KPIN12) + Q12(PIN22) 
QP21 = Q12(PIN11) + Q22(PIN12) 
QP22 = Q12(PIN12) + Q22(PIN22) 



and D(l/0) was initialized as the identity matrix. These are the terms 
used in the Kalman filter program to solve for sequential values of the 
D matrix as seen on page 84. 
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APPENDIX C 



DERIVATION OF PLANE TRIANGULATION 
SOLUTION 



From Figure 1 it can be seen that 
Xt-Xj 



A 

tan0. = 



and tan 0£ = 



Xt- Y. 



X^ - Xf 

Xrj. -Yf 



(1C) 



(2C) 



Substituting latitude (L)/longitude (X) coordinates for the X/Y axes of 
the flat earth model results in angular measurement of distance in the 
plane. Since equal angles of latitude and longitude yield equal distances 
of movement only at the equator, a correction factor must be applied to 
longitude angular measure as either pole is approached from the equator. 

At 60® North latitude, for example, one degree of movement 
measures sixty nautical miles while one degree of movement in longi- 
tude only measures thirty nautical miles. This requires that the longi- 
tude angular measure be corrected by the cosine of the local latitude 
coordinate so that the tangent ratio terms will have units of the same 
dimensional size. This results in the equations given below: 



^ ( Xiy — X:)cOSLrp, 

tan0i = 



Lt - L 



tan0f 



( X.J' — X£)^OSLrp 

Lrp — L^ 



(30 



(40 
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These two equations could be solved simultaneously for the two unknowns 
Lrp and X,p, except that the unknown L,p also appears as a cosine function. 
The method chosen to resolve this difficulty allowed a known midlatitude 
function 

Lj + L|£ 

WAV = (5C) 

to be used in approximating an intermediate value of emitter target 
latitude TILA where 

■ (X. - XJcos(WAV) + Litan§. - L tan0 

TILA = — i : ^ 1 L- (60 

tan0j - tan0£ 

results from substituting cos(WAV) for cosL-^ in a simultaneous solution 
of equations (3C) and (4C) for L,p. It should be noted that this midlati- 
tude approximation is only valid if the aircraft position latitude is within 
a few degrees of the emitter location latitude. This approximation would 
not be valid for HF sky wave radiation transmitted from an emitter at 
great distances from the receiving aircraft. For situations in which the 
approximation is valid, equations (28) and (29) give a corrected solution 
for emitter latitude and longitude based on the intermediate latitude 
function TILA. 
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APPENDIX D 



DERIVATION OF SPHERICAL EARTH 
TRIANGULATION SOLUTION 



Figure 4a describes the geometry of the spherical triangulation 
solution, in which the arc length sides of the spherical triangles must 
be measured from the angle subtended at the center of the sphere. 

Since latitude (L) and longitude (X) lines meet at right angles and 0^ 
and 6f are known, then two angles of the spherical triangles are known. 
This allows the side opposite and the side adjacent to the emitter bear- 
ing angle 0 to be computed. 

Using the Law of Sines and the Angle Law of Cosines for spherical 
triangles, the general solution equations may be derived as follows from 
Figures 4b and 4c: 



sin(A) sin(B) . ... sin(B)sin(a) 

or sin(A; =- 



(ID) 

(2D) 



Sine Law: sin(a) sin(b) sin(b) 

Cosine Law: cos(A) = -cos(B)cos(C) + sin(B)sin(C)cos(a). 

For angle C = 90® equation (2D) reduces to 

cos(A) = sin(B)cos(a) . (3D) 



Dividing equation (ID) by (3D) yields 
sin(A) _ tan(a) 



tan(A) = 



cos(A) 



sin(b) 



(4D) 



where a and b are angular arcs of the spherical triangles measured at 
the center of the sphere. From Figures 4b and 4c, b is an arc of latitude 
and a is an arc of longitude which must be corrected for the local latitude 
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at which it is measui'ed. Therefore, 



a ~ ( X'p “ X)cosLrp 



(5D) 



and b = Lrp - L . 

Substituting these values of a and b into equation (5D) results in 

tan[(Xrp- X--)cosL™ 

tan = i i i i-J 

sin(Lrp - L-^ 



(6D) 



(7D) 



and 



tan ~ 

sin(Lrji — l-^£ ^ 



(8D) 



which give the exact solution for emitter location on a spherical earth 
of constant radius. 
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APPENDIX E 



COMPUTER ITERATION SOLUTION TO 
SPHERICAL TRIANGULATION 
EQUATIONS 

No closed-form solution to the two spherical triangulation 
equations (30) and (31) could be found since the unknowns (L^, X^) are 
enmeshed within multiple trigonometric relations. Instead, an itera- 
tive approximation computer solution was developed which allowed 
successive numerical updating of previously computed values. This 
method is only as good as the initial estimate with which it commences, 
so it is best described as a spherical earth correction procedure to the 
plane triangulation solution for emitter location. The procedure is 
concerned with updating values of the following terms 
DTLAI = Lrp - L| 

DTLAF = L^ - Lj 

DTLOI = X^ - X. 

DTLOF = " ^f 

by sequentially recomputing them from rearranged versions of equations 
(30) and (31). The procedure is repeated and successive terms are 
compared until a satisfactory solution is reached. See the computer 
subroutine on the following page for a further explanation of the iterative 

process. 
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C ^ 

C * SPHERICAL EARTH SOLUTION SUBROUTINE 

C * 

c 

C CORRECTIONS TO PLANE TR I ANGULATI ON SOLUTION FOR 
C A SPHERICAL EARTH 
C 

DO 40 I=1,NTAR 
NSTA=NST(I) 

KI = JSET( I , 1) 

KF=JSET( I,NSTA) 

DO 42 M=1 ,5 
CTLA=COS(TLA(I ) ) 

DTLAI=TLA( I)-SLA(KI) 

DTLAF=TLA( I)-SLA(KF) 

DTLOI=TLO( I )-SLO(KI) 

DTLOF=TLO( 1 )-SLO(KF) 

DTL0I=ATAN(TAN(THT1(KF) )=!'S INI DTLA I ) I/CTLA 
DTLOF=ATAN(TAN(THT(KF) )«SIN(DTLAF) )/CTLA 
DTLAI=ARSIN(TAN(DTL0I*CTLA)/TAN(THT1(KF) ) ) 

DTLAF = ARSIN(TAN(DTLOF=!'CTLA)/TAN(THT(KF) ) ) 
TLAI=DTLAI+SLA(KI ) 

TLAF=DTLAF+SLA(KF) 

TLOI=DTLOI+SLO(KI ) 

TLOF=DTLOF+SLO(KF) 

TLADI=TLAI*PIRAD 

TLADF=TLAF*PIRAD 

TLODI=TLOI*PIRAD 

TL0DF=TL0F*P1RAD 

WRITE! 6,44) TLADI I ) , TL ADI , T L ADF , T LOD ( I ) , TLODI , T LODF 
44 FORMAT! 'O' ,6F15.5) 

TLA! I )=!TLAi+TLAF)/2.0 
TLO! I) =!TLOI+TLOF) /2 .0 
TLAD! I ) = TLA! I )=5<PIRAD 
TLOD! I )=TLO! I ) *PIRAD 
42 CONTINUE 
40 CONTINUE 
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APPENDIX F 



DERIVATION OF EXTENDED KALMAN FILTER 
SCALAR EQUATIONS 

The extended Kalman filter recursion equations (42), (43), and 
(44) are similar in form to the basic Kalman filter recursion equations 
on page 11, except that the observation matrix is a non-linear transfor- 
mation matrix M as defined by equation (41) where 



M(k) = 



^T 1 


r ae 


be 1 


r q 


ax = 






= DMX DMY 



(IF) 



Taking partial derivatives of equation (24) yields 



DMX = 



DMY = 





(L^ 


- L^)cosL^ 




(L^ - L.)^ 


+ (X^ - X.)^cos^L^ 


ae 


-(Xt - Xj) 


|^(L-p - L.)sinLrj^ + cosL, 


dL^ 


(Lrp - L«) 


+ ( Xrj, - X|)^COS^L,p 



(2F) 



(3F) 



These terms are computed numerically and substituted into equations 
(42) and (43) which are rewritten in matrix form as 

Pll P12 
P21 P22 DMY 



GX' 




Pll 


PI 2' 




DMX' 


fr 


GY 




P21 


P22^ 




DMY 





DMX DMyJ 



'dmx' 



+ R 



-1 

(4F) 



and 



Pll PI 2" 




1 0 




"pil P12*' 




f 

1 0 




"q11 Q12^ 
















+ 




P21 P22^ 




0 1 




P21 P22 




0 1 




Q12 Q22 



k+l/k 



(5F) 
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Equation (43) is then substituted into (5F); however, the fact that the 
matrix reduces to the identity matrix for the stationary filtered 
states (L-p, X-p) considerably simplifies the recursion equations since 
they are no longer dependent on the sampling interval T(k). Since the 
gain terms are computed as a function of the non-linear terms DMX 
and DMY, it is essential to have the correct units on the error term 
E(k). In this case the units of gain are not dimensionless but degrees per 
radian, so the error term must be given in radians to update position 
estimates given in degrees of latitude and longitude. 

These scalar equations may then be written out and programmed 
sequentially as was done in Appendix A for the linear recursion 
equations. See page 92 for a listing of these equations within the exten- 
ded Kalman filter subroutine. 
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APPENDIX G 



MONTE CARLO SIMULATION ERROR ANALYSIS 
ESTIMATED EMITTER POSITION ERROR IN NAUTICAL MILES 





EMITTER # 


1 




EMITTER # 2 




DLATl 


DLONl 


DRNGl 


DLAT2 


0L0N2 


DRNG2 


0.73975 


0.98967 


1.23559 


0.29480 


0.08906 


0 .30796 


-0.17944 


-0.15609 


0.23783 


0.34882 


-0.20192 


0.40305 


0.40009 


-0.01287 


0.40029 


-0.28107 


-0.41036 


0.49738 


0.93292 


0.40690 


1. 01780 


-0.87250 


0.28671 


0.91840 


-0.17761 


-0. 138S5 


0.22545 


-0.29205 


0.22405 


0.36809 


0.33783 


-0.09862 


0.35193 


-1.02905 


0.14354 


1.03901 


-0.71135 


0.51^03 


0.87765 


-1. 19751 


0.13350 


1.20493 


-0.60425 


-0.53403 


0.80642 


0.35243 


0.27276 


0.44569 


0.07324 


0.03655 


0. 081 86 


0.06317 


0.09631 


0.11518 


-1.38245 


0.37886 


1.43342 


1.10687 


-0.43230 


1.18829 


0.61066 


0.05379 


0.61302 


0.30762 


-0.20006 


0.36695 


-0.47058 


0.07356 


0. 47630 


-0.10986 


-0.01153 


0 .1 1047 


-0.31036 


0.19127 


0.36457 


-0.63390 


-0.07289 


0.68777 


1.21033 


0.20184 


1.22704 


0.23712 


0.14354 


0.27718 


-0.23254 


0. 17724 


0.29239 


0.10986 


0.32743 


0.34537 


-0.02930 


-0.07058 


0.07642 


0.06500 


-0.29322 


0.30034 


0.32593 


-0.18253 


0.37356 


-0.47699 


-0.19058 


0.51365 


-0.45 135 


0.29495 


0.53918 


0.05768 


0.26217 


0.26844 


-0.22797 


0.23334 


0.32621 


0.25726 


-0.32259 


0.41262 


0. 81482 


0.16989 


0. 83234 


-0.86243 


-0.36052 


0 .93475 


-0.33691 


0.27610 


0.43559 


-0.47424 


0.01636 


0.47453 


-0.49713 


-0.01207 


0.49730 


0.33508 


-0.06824 


0.34196 


0.40100 


0.31886 


0. 51232 


-0.59967 


0.01171 


0.59978 


0.08881 


0.26115 


0.27584 


0.00732 


0.56970 


0.56975 


-0.44952 


0.03000 


0.45659 


-0.07690 


-0 .05411 


0.09403 


-0.37354 


-0. 26644 


0. 45882 


0.24445 


-0.35309 


0.42945 


-0.09796 


0.3o414 


0.37709 


0.81848 


-0.29322 


0.86942 


0.37354 


-0.11173 


0.36989 


0.07965 


0. '427 83 


0.43513 


0.67566 


0.35909 


0.76515 


0. 34058 


0.07693 


0.34917 


-0.46326 


0.26874 


0.53556 


-0.03387 


0.34323 


0.34490 


0.41565 


0.06851 


0.42126 


-1.18652 


0.08906 


1.18986 


-0.53192 


0.39633 


0.66334 


-0.01831 


-0.36443 


0.36489 


-0.17395 


-0.07540 


0.18959 


0.21790 


-0. 13071 


0.25409 


-0.25818 


0.10161 


0. 27745 


-0.07233 


0.15823 


0.17398 


-0.64178 


0.29173 


0.70498 


-0.43030 


0.15749 


0.45821 


-0.75256 


0.13609 


0.76477 


-0.16479 


0.24748 


0.29733 


0.26825 


-0.06483 


0. 27597 


0.65643 


-0 .30453 


1.03835 


-0.55756 


0 . 16253 


0.58076 


-0.28198 


-0.06739 


0.29521 


-0.60883 


0.66208 


0.39945 


0.26276 


0.22405 


0.34531 


0.13092 


0.35587 


0.37919 


-1.25793 


-0.15135 


1.26701 


-0.09979 


-0.02851 


0.10378 


1.01257 


-0.46632 


1.11479 


— 0. 40649 


-0.04828 


0.40935 


-0.22614 


-0.06154 


0.23436 


-0.06958 


0.09081 


0.11440 


-0. 18036 


-0.49700 


0.52871 


-1.16730 


-0.02598 


1.16759 


0.35339 


-0.12681 


0.37546 


0.04486 


0.34024 


0. 34318 


-0.29297 


-0.01748 


0.29349 


-0.32043 


0.63817 


0.71410 


-0.25818 


-0.33654 


0.42416 


-1.08307 


0.35840 


1.14083 


0.27740 


-0 .41705 


0.50088 


0. 17578 


0.39633 


0. 43356 


0.48340 


0.29545 


0.56654 


0.12360 


0.04874 


0.13286 


-0.25635 


-0.07084 


0.26596 


-0.61523 


0.16322 


0.63652 


-0.07416 


—0 . 160 65 


0.17694 




AVERAGE 


ERROR IN NAUTICAL MILES 




AVERAGE 


AVERAGE 


AVERAGE 


AVERAGE 


AVERAGE 


AVERAGE 


LATITUDE 


LONGITUDE 


RANGE 


LATITUDE 


LONGITUDE 


RANGE 


ERROR 


• ERROR 


ERROR 


- ERROR 


ERROR 


ERROR 


0.44852 


0.23376 


0. 53692 


0.39961 


0.23108 


0.50758 
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AIRCRAFT FLIGHT DATA COMPUTER OUTPUT 



LISTING OF BEARING ANGLES-OF-ARRIV AL AND AIRCRAFT NAVIGATION DATA 



N HDGD(N) 



SLAD(N) SLOD(N) BRNGO(N) THETAO(N) THETA(N> 



1 135.52739 

2 135.64830 

3 135.48329 

4 135.41739 

5 135.31882 

6 135.30740 

7 135.00026 

8 135.06616 

9 135.28560 

10 135.51651 

11 135.61504 

12 135.56006 

13 135.49416 

14 135.43913 

15 135.38472 

16 135.30740 

17 135.16473 

18 134.45079 

19 131.33047 

20 122.29950 

21 120.58583 

22 120.73991 

23 120.76172 

24 120.76172 

25 120.87172 

26 120.98116 

27 121.36617 

28 121.44293 

29 121.57474 

30 121.58560 

31 120.76172 

32 120.89346 

33 121.27792 

34 119.94865 

35 120.68495 

36 120.70670 

37 121.12437 

38 121.17940 

39 120.91527 

40 120.72844 

41 120.66260 

42 120.65167 

43 119.66331 

44 119.27831 

45 118.99298 

46 118.83884 

47 118.71851 

48 118.74031 

49 118.72943 

50 118.82796 

51 119.64102 

52 120.40988 

53 120.64079 

54 120.65167 

55 120.88258 

56 121.12437 

57 121.22295 

58 120.21225 

59 120.75079 

60 120.77260 

61 121.01439 

62 121.15704 

63 121.15704 

64 119.75102 

65 119.79510 



33.35472 
33.33582 
33.31691 
33.30316 
33.28426 
33.28426 
33.26993 
33.25504 
33.24701 
33.23727 
33.22752 
33.22353 
33.21779 
33.21378 
33.20461 
33. 19888 
33. 19431 
33.18570 
33.18112 
33.16908 
33.16507 
33.15591 
33.15477 
33.15247 
33. 14847 
33. 14159 
33.13127 
33. 12840 
33.1215^ 
33. 12154 
33.10606 
33.10434 
33.09747 
33.08716 
33.08028 
33.07971 
33.07397 
33.05965 
33. 05794 
33.05679 
33.04991 
33. 04935 
33.03215 
33.02585 
33.02184 
33.01840 
33. 01553 
33.00923 
33.00522 
33.00293 
32.99892 
32.99261 
32.98230 
32.97887 
32.97485 
32.96855 
32.96683 
32.96111 
32.95137 
32.95079 
32.9A391 
32.94048 
32.93646 
32.92902 
32.92615 



■ 120 . 
- 120 . 
■ 120 . 
■ 120 . 
- 120 . 
■ 120 . 
- 120 . 
■ 120 . 
■ 120 . 
■ 120 . 
- 120 . 
■ 120 . 
- 120 . 
■ 120 . 
■ 120 . 
■ 120 . 
■12 0 . 
■ 120 . 
■ 120 . 
- 120 . 
■ 120 . 
■ 120 . 
■ 120 . 
- 120 . 
■ 120 . 
■ 120 . 
■ 120 . 
■ 120 . 
■ 120 . 
■ 120 . 
■ 120 . 
• 120 . 
■ 120 . 
■ 120 . 
• 120 . 
■ 120 . 
■ 120 . 
■ 120 . 
■ 120 . 
■ 120 . 
- 120 . 
■ 120 . 
■ 120 . 
■ 120 . 
■ 120 . 
- 120 . 
■ 120 . 
■ 120 . 
- 120 . 
■ 120 . 
- 120 . 
■ 120 . 
- 120 . 
■ 120 . 
■ 120 . 
- 120 . 
- 120 . 
- 120 . 
- 120 . 
- 120 . 
■ 120 . 
- 120 . 
- 120 . 
■ 120 . 
■ 120 . 



90094 
87630 
85220 
83391 
80925 
80925 
79089 
77144 
75996 
74796 
73532 
73019 
72276 
71758 
70555 
69812 
69238 
68091 
67462 
65343 
64 539 
62419 
62250 
61576 
60812 
59326 
57091 
56517 
55086 
55026 
51649 
51305 
49373 
47638 
46147 
45976 
4^655 
4156 2 
4127G 
40988 
39502 
39442 
35721 
34229 
33426 
32623 
31995 
30502 
29590 
28957 
28099 
26721 
24486 
23804 
22940 
21568 
21164 
19908 
17842 
17728 
16356 
15607 
14749 
13258 
12630 



283.69995 
282.10010 

286.89990 

280. 80005 

300.99976 
279.90015 

278 .49976 

314.80005 
277.30005 
275.89966 

312.79980 

277.30005 
312.29956 
275.40015 

273.79980 

311.60010 

311.29980 

299.49976 

276.00000 

291.79980 

275.69971 

283.30005 

276.30005 

258.39990 

275.19995 
274.19971 
275 .09985 

280. 89990 

308.69971 

289.60010 

287.60010 

279.69995 

273.29980 

309.39990 

287.29980 

272.19995 
276.50024 
315 .00000 

283.39966 

275.00000 

306.99976 

274.30005 
287 .19946 

285.69995 

312.79980 
312 .00000 
276.50024 
272.19995 
311 .09985 

282.99976 
309.000C0 

271.89990 
267.10010 

267.00000 
3 06. 10034 

266.80005 
276.59985 

264.00000 

263.39990 

301.39966 
•277.89990 

298.39966 

257.09985 

257.00000 

278.09985 



59. 22729 
57.74829 
62.38306 
56.21729 
76.31836 
55. 20752 
53.50000 
89.86621 
52. 58545 
51.41602 
88.41479 
52.86011 
87 .79370 
50.83911 
49. 18433 
86.90747 
86.46436 
73.95044 
47.33032 
54.09912 
36.28540 
44.03979 
37.06177 
19 .16162 
36.07153 
35. 18066 
36.46582 
42.34277 
70.27441 
51 .18555 
48.3 6182 
40.59326 
39.57764 
69.34839 
47.98462 
32.90649 
57.62451 
76.17920 
44.31470 
35.72827 
67.66235 
34.95166 
46.86255 
44.97803 
71.79272 
70.83862 
35.21875 
30.94019 
69.82910 
41.82764 
68.64087 
32.30957 
27.74072 
27.65161 
66.98291 
27.92432 
37.82275 
24.21216 
24.15063 
62.17212 
38.91406 
59.55664 
18.25684 
16.75098 
37. 89478 



1. 03371 
1.00790 
1.08879 
0.98118 
1. 33201 
0. 96355 
0. 93375 
1 . 56846 
0. 91779 
0. 89738 
1.54313 
0.92258 
1.53229 
0.88731 
0. 85843 
1.51632 
1.50909 
1. 29068 
0.82607 
0. 94421 
0.63330 
0.76864 
0.64635 
0.33443 
0.62957 
0.61402 
0.63645 
0.73902 
1. 22652 
0.89336 
0. 84407 
0.70849 
0.69076 
1.21036 
0. 83749 
0.57433 
0. 65667 
1.32958 
0.77344 
0.62358 
1. 18G93 
0.61002 
0.81791 
0.78502 
1.25302 
1.23 63 7 
0.61468 
0. 54001 
1.21875 
0. 73 003 
1. 19801 
0.56391 
0.48417 
0.48261 
1 . 16907 
0.48737 
0.66013 
0. 42258 
0. 42151 
1.08511 
0.67918 
1. 03946 
0.31864 
0.29236 
0. 66139 
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NTAR 



1 



UNFILTERED EMITTER TARGET DATA INITIALLY ASSOCIATED TO NTAR = 1 

EMITTER BEARING LINES OF SIMILAR FREQUENCY AND PRF OR PRF MULTIPLE 



NUM 


FREQ 


PRF 


PW 


HDGD 


BRNGD 


THETAD 


1 


2872.0 


320.0 


2.40 


135.52739 


283.69995 


59. 22729 


2 


2872. 0 


322.0 


2.50 


135.64830 


282.10010 


57.74829 


4 


2872.0 


320.0 


2.50 


135.41739 


280.80005 


56.21729 


6 


2872.0 


318.0 


2.40 


135.30740 


279.90015 


55.20752 


7 


2872.0 


320.0 


2.60 


135.00026 


278.49976 


53.50000 


9 


2872.0 


319.0 


2.20 


135.28560 


277.30005 


52. 58545 


10 


2872.0 


321.0 


2.50 


135.51651 


275.89966 


51.41602 


14 


2872.0 


320.0 


2. 60 


135.43913 


275.40015 


50.83911 


15 


2872.0 


320 .0 


2.20 


135.38472 


273. 79980 


49. 18433 


19 


2872. 0 


320.0 


2.40 


131.33047 


276.00000 


47.33032 


28 


2872.0 


319.0 


2.60 


121.44293 


280. 89990 


42.34277 


32 


2872. 0 


319.0 


2.50 


120.89346 


279.69995 


40. 59326 


33 


2872. 0 


320.0 


2.50 


121.27792 


278.29980 


39.57764 


37 


2872.0 


320.0 


2.40 


121.12437 


276.50024 


37. 62451 


40 


2872. 0 


320.0 


2.50 


120.72844 


275.00000 


35. 72827 


42 


2872.0 


320.0 


2.50 


120.65167 


274.30005 


34.95166 


48 


2872. 0 


319.0 


2.30 


118.74031 


272. 19995 


30.94019 


53 


2872. 0 


323.0 


2.80 


120.64079 


267.10010 


27.74072 


54 


2872.0 


320.0 


2.50 


120.65167 


267. 00000 


27. 65161 


59 


2872.0 


322.0 


2.50 


120.75079 


263.39990 


24. 15063 
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NTAR 



2 



UNFILTERED EMITTER TARGET DATA INITIALLY ASSOCIATED TO NTAR = 2 

EMITTER BEARING LINES OF SIMILAR FREQUENCY AND PRF OR PRF MULTIPLE 



NUM 


FREQ 


PRF 


PW 


HDGD 


BRNGD 


THETAD 


3 


2876. 0 


306.0 


2.40 


135.48329 


286.89990 


62.38306 


20 


2878.0 


304.0 


2. 40 


122.29950 


291. 79980 


54. 09912 


24 


2876.0 


305.0 


2.40 


120.76172 


258.39990 


19. 16162 


30 


2878. 0 


306.0 


2.30 


121.58560 


289.60010 


51.18555 


35 


2876.0 


306.0 


2.30 


120.68495 


287.29980 


47. 98462 


43 


2876. 0 


306.0 


2.40 


119.66331 


287.19946 


46. 86255 


44 


2876.0 


306.0 


2.30 


119.27831 


285.69995 


44. 97803 


50 


2876.0 


306.0 


2.50 


118.82796 


282.99976 


41. 82764 


61 


2876. 0 


306.0 


2.30 


121.01439 


277.89990 


38.91406 


65 


2876.0 


3 06.0 


2.40 


119.79510 


278. 09985 


37. 89478 
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NTAR 



3 



UNFILTERED EMITTER TARGET DATA INITIALLY ASSOCIATED TO NTAR = 3 

EMITTER BEARING LINES OF SIMILAR FREQUENCY AND PRF OR PRF MULTIPLE 



NUM 


FREQ 


PRF 


PW 


HDGD 


BRNGD 


THETAD 


5 


2846.0 


370.0 


2.30 


135.31882 


300.99976 


76.31836 


18 


2846. 0 


370.0 


2.30 


134.45079 


299.49976 


73.95044 


29 


2846.0 


370.0 


2.40 


121. 57474 


308.69971 


70.27441 


34 


2846. 0 


370.0 


2.40 


1 19.94865 


309.39990 


69.34839 


41 


2846. 0 


370.0 


2.40 


120. 66260 


306.99976 


67.66235 
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NTAR 



4 



UNFILTERED EMITTER TARGET DATA INITIALLY ASSOCIATED TO NTAR = 4 

EMITTER BEARING LINES OF SIMILAR FREQUENCY AND PRF OR PRF MULTIPLE 



NUM 


FREQ 


PRF 


PW 


HDGD 


BRNGD 


THETAD 


8 


5556.0 


320.0 


1.00 


135.06616 


314. 80005 


89. 86621 


13 


5554. 0 


640.0 


1.10 


135.49416 


312.29956 


87.79370 


16 


5556. 0 


320.0 


1.00 


135.30740 


311. 60010 


86.90747 


23 


5556. 0 


640.0 


1.00 


120.76172 


276.30005 


37.06177 


25 


5556.0 


320.0 


1.10 


120.87172 


275.19995 


36.07153 


27 


5554.0 


640.0 


1.10 


121.36617 


275.09985 


36.46582 


36 


5554. 0 


640.0 


1.10 


120.70670 


272.19995 


32.90649 


46 


5554.0 


640.0 


0.90 


118. 83884 


312. 00000 


70.83862 


49 


5554. 0 


320.0 


1.00 


118.72943 


311.09985 


69. 82910 


58 


5556. 0 


640.0 


1.00 


120.21225 


264.00000 


24.21216 


63 


5556.0 


640.0 


1.00 


121. 15704 


257. 09985 


18.25684 


64 


5556.0 


320.0 


1.10 


119.75102 


257.00000 


16. 75098 



59 



i 




NTAR 



5 



UNFILTERED EMITTER TARGET DATA INITIALLY ASSOCIATED TO NTAR = 5 

EMITTER BEARING LINES OF SIMILAR FREQUENCY AND PRF OR PRF MULTIPLE 



NUM 


FREQ 


PRF 


PW 


HDGD 


BRNGD 


THETAD 


11 


5506. 0 


640.0 


0.60 


135.61504 


312.79980 


88.41479 


17 


5504.0 


640.0 


0.60 


135.16473 


311. 29980 


86.46436 


21 


5504.0 


640.0 


0.60 


120.58583 


275.69971 


36.28540 


26 


5504.0 


640.0 


0.60 


120.98116 


274.19971 


35.18066 


38 


5504.0 


640.0 


0.60 


121.17940 


315.00000 


76. 17920 


45 


5506. 0 


640.0 


0.70 


118.99298 


312.79980 


71.79272 


51 


5504.0 


642.0 


0.60 


119.64102 


309. 00000 


68.64087 


55 


5504.0 


640.0 


0.60 


120.88258 


306. 10034 


66.98291 


60 


5504. 0 


642.0 


0.60 


120.77260 


301. 39966 


62.17212 



60 



NTAR 



6 



UNFILTERED EMITTER TARGET DATA INITIALLY ASSOCIATED TO NTAR = 6 

EMITTER BEARING LINES OF SIMILAR FREQUENCY AND PRF OR PRF MULTIPLE 



NUM 


FREQ 


PRF 


PW 


HDGD 


BRNGD 


THETAD 


12 


2876.0 


359.0 


2.20 


135.56006 


277.30005 


52. 86011 


22 


2876. 0 


359.0 


2.20 


120.73991 


283.30005 


44. 03979 


47 


2876. 0 


3 59.0 


2.40 


11 8.71851 


276. 50024 


35.21875 


52 


2874.0 


359.0 


2.40 


120.40988 


271. 89990 


32.30957 


56 


2876. 0 


359.0 


2.20 


121.12437 


266.80005 


27.92432 


62 


2874. 0 


359.0 


2.40 


121. 15704 


298.39966 


59.55664 
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NTAR 



7 



UNFILTERED EMITTER TARGET DATA INITIALLY ASSOCIATED TO NTAR = 7 

EMITTER BEARING LINES OF SIMILAR FREQUENCY AND PRF OR PRF MULTIPLE 



NUM 


FREQ 


PRF 


PW 


HDGD 


BRNGD 


THETAD 


31 


9268.0 


500.0 


0.20 


120.76172 


287.60010 


48.36182 


39 


9268. 0 


499.0 


0.20 


120.91527 


283.39966 


44.31470 


57 


9270.0 


5 00.0 


0.30 


121.22295 


27 6. 59985 


37. 82275 
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INITIAL JSET J3ATA 

Z' 

JSETd, l')= 1 

jSETd, 2)= 2 

JSETd, 3)= 4 

JSETd, 4)= 6 

JSETd, 5)= 7 

JSETd, 6)= 9 

JSETd, 7)= 10 
JSETd, 8)= 14 
JSETd, 9)= 15 
JSETd, 10)= 19 
JSETd, 11)= 28 
JSETd, 12)= 32 
JSETd, 13)= 33 
JSET( 1,14) = 37 
JSET{ 1, 15)= 40 
JSETd, 16)= 42 
JSETd, 17)= 48 
JSETd, 18)= 53 
JSETd, 19)= 54 
JSETd, 20)= 59 
JSET(2, 1)= 3 

JSET(2, 2)= 20 
JSET(2, 3)= 24 
JSETI2, 4)= 30 
JSET(2, 5)= 35 
JSETI2, 6) = 43 
JSET(2, 7)= 44 
JSET(2, 8)= 50 
JSET(2, 9)= 61 
JSETI2, 10)= 65 
JSET(3, 1)= 5 

JSET(3, 2)= 18 
JSET(3, 3)= 29 
JSET(3, 4)= 34 
JSET(3, 5)= 41 
JSET(4, 1)= 8 

JSET(4, 2)= 13 
JSETI4, 3)= 16 
JSETI4, 4)= 23 
JSET(4, 5)= 25 
JSET(4, 6)= 27 
JSET(4, 7)= 36 
JSET14, 8)= 46 
JSETI4, 9)= 49 
JSET(4,10)= 58 
JSET(4,11)= 63 
JSET(4,12)= 64 
JSETI5, 1)= 11 
JSET(5, 2)= 17 
JSETI5, 3)= 21 
JSETI5, 4)= 26 
JSET(5, 5)= 38 
JSET(5, 6)= 45 
JSET(5, 7)= 51 
JSET(5, 8)= 55 
JSETI5, 9)= 60 
JSET(6, 1)= 12 
JSET(6, 2)= 22 
JSET(6, 3)= 47 
JSET(6, 4)= 52 
JSET(6, 5)= 56 
JSETI6, 6)= 62' 
JSETI7, 1)= 31 
JSET(7, 2)= 39 
JSET(7, 3)= 57 
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I 




K 

1 

2 

4 

6 

7 

9 

10 

14 

15 

19 

28 

32 

33 

37 

40 

42 

48 

53 

54 

59 

3 

20 

24 

30 

35 

43 

44 

50 

61 

65 

5 

18 

29 

34 

41 

8 

13 

16 

23 

25 

27 

36 

46 

49 

58 

63 

64 

11 

17 

21 

26 

38 

45 

51 

55 

60 

12 

22 

47 

52 

56 

62 

31 

39 

57 



FILTER PARAMETERS 
T(K) E(K) 



LISTING OF 
Gl(K) 



0.98580 
0.99996 
0.91370 
0.66077 
0. 51469 
0.50206 
0. 38820 
0.39830 
0.32591 
0. 33848 
0. 50143 
0.44026 
0. 33461 
0.35500 
0.33730 
0.28037 
0.39363 
0. 40188 
0.30055 
0.34579 

0.98580 
1. 00000 
0.61665 
0.78886 
0. 66823 
0.65760 
0.42984 
0.42162 
0. 58649 
0.44875 

0.98580 
1. 00000 
0.82455 
0.62591 
0.57737 

0.98580 
0. 99999 
0.71699 
0.79911 
0. 83155 
0.88655 
0.95376 
0.97787 
0.56372 
0.74102 
0.84422 
0. 86349 

0.98580 
0.99999 
0.83310 
0.92856 
0.98610 
0.69876 
0. 57013 
0.51924 
0.48515 

0.98580 

1.00000 

0.95323 

0.61332 

0.56416 

0.56612 

0.98580 

1.00000 

0.91990 



KALMAN 

G2(K) 



0.0 

0.05132 
0.01972 
0.01124 
0.00771 
0.00621 
0.00452 
0.00402 
0.00314 
0. 00292 
0.00304 
0.00291 
0.00230 
0.00256 
0.00245 
0.00206 
0.00255 
0. 00270 
0.00205 
0.00244 

0.0 

0.00638 
0. 00505 
0. 00532 
0.00511 
0. 00448 
0. 00306 
0.00325 
0.00358 
0.00309 

0.0 

0. 00972 
0.00552 
0.00437 
0. 00393 

0.0 

0.02562 
0.01466 
0.00917 
0.00864 
0.00742 
0.00498 
0.00351 
0.00543 
0.00787 
0. 00683 
0.00651 

0.0 

0.02916 
0.01454 
0.01037 
0.00478 
0.00599 
0.00525 
0. 00459 
0.00395 

0 . 0 

0.01272 
0.00368 
0. 00567 
0.00613 
0.00549 

0.0 

0.01452 
0. 00521 



19.48511 
34. 17871 
19.57300 
14. 74170 
24.46582 
9.74414 
24.43945 
9.80640 
24.56360 
73.93848 
34.57783 
9. 83130 
34.441 16 
24.61328 
9. 84668 
58.93970 
39.44409 
4.93677 
39.42358 

0.0 

156.82422 
24.59717 
69. 00879 
59.16089 
68.85083 
9. 78320 
34.46094 
83. 76660 
24. 76538 

0.0 

102. 83667 
88.72388 
49.30444 
54. 13794 

0.0 

39.03418 
19.63843 
54.08618 
63.97461 
83. 63501 
162.59375 
251. 06714 
19.68750 
64.11743 
98. 58325 
108.48877 

0.0 

34. 29346 
34.41162 
68.95825 
187. 19775 
54.06836 
34.47925 
34. 46753 
34.52881 

0 . 0 

78.58911 

201.91919 

34.48828 

34.49512 

39.41577 

0.0 

68. 88379 
132. 89380 



-0.54543 
1.06322 
0.15733 
-0. 87030 
0.12813 
-0. 52989 
0. 60146 
-0.71368 
-0.82887 
-0. 82394 
0.12999 
-0.29539 
0. 14192 
-0. 17 59 3 
-0. 23737 
-0.22783 
-0.66829 
-0. 14583 
-0.85219 



-0. 86391 
-33.63820 
0.73169 
-0. 15179 
2.24968 
-0.72655 
-2. 12259 
-0.05772 
0. 16925 



1.98647 

-1.63304 

0.36708 

0.09885 



-0.70366 
0. 15646 
-47. 05379 
-47.54167 
-45. 89462 
-45. 69676 
-3. 27011 
0. 14413 
-41.61142 
-45.44742 
-46.34418 



-0. 70633 
-48. 22182 
-47.36174 
0. 36156 
-1.39986 
-1.38312 
0. 18741 
-2.30612 



-4. 96594 
13.84093 
-0. 14958 
-2.30110 
33.63329 



-0.75569 

1.31592 



GATE(K) 



974.29150 
20. 42409 
10.30163 
8. 61279 
8. 50278 
7.67091 
7.73504 
7.30789 
7.37700 
8. 49747 
8. 01970 
7.35553 
7. 47088 
7.37042 
7. 07287 
7. 70516 
7.75814 
7. 17417 
7.41809 



7841. 21484 
9. 69064 
13. 05779 
10. 41681 
10.25372 
7. 94606 
7. 88938 
9.33059 
8. 08118 



5141.83984 
14. 32434 
9. 80986 
9. 22935 



1951.72705 
11. 27851 
13. 38674 
14.61884 
17. 81369 
27.90096 
40.32851 
9. 03385 
11.79007 
15. 20187 
16. 23961 



1714. 69336 
14. 68663 
22.44804 
50. 88951 
10.93197 
9. 15131 
8. 65340 
8.36201 



3929. 46289 
27.74507 
9. 64890 
9. 08843 
9. 10896 



3444.19727 

21.20036 
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FINAL JSET DATA 



JSETd, 


1) = 


1 


JSET( 1, 


2) = 


2 


JSETd, 


3) = 


4 


JSETd, 


4) = 


6 


JSETd, 


5) = 


7 


JSETd, 


6) = 


9 


JSETd, 


7) = 


10 


JSETd, 


8) = 


14 


JSETd, 


9) = 


15 


JSETd, 


10) = 


19 


JSET{ 1 , 


11) = 


28 


JSET( 1, 


12) = 


32 


JSETd, 


13) = 


33 


JSETd, 


14) = 


37 


JSET( 1, 


15) = 


40 


JSETd, 


16) = 


42 


JSETd, 


17) = 


48 


JSETd, 


18) = 


53 


JSETd, 


19) = 


54 


JSETd, 


20) = 


59 


JSET( 2, 


1) = 


3 


JSET(2, 


2) = 


20 


JSET( 2, 


3) = 


30 


JSET( 2, 


4) = 


35 


JSET(2, 


5) = 


43 


JSET( 2, 


6) = 


44 


JSET( 2, 


7) = 


50 


JSET(2, 


8) = 


61 


JSET( 2, 


9) = 


65 


JSET (3, 


1) = 


5 


JSETd , 


2) = 


18 


JSETd, 


3) = 


29 


JSET (3, 


4) = 


34 


JSETd, 


5) = 


41 


JSET(4, 


1) = 


8 


JSET(4, 


2) = 


13 


JSET(4, 


3) = 


16 


JSET(4, 


4) = 


46 


JSETI4, 


5) = 


49 


JSET(5, 


1) = 


11 


JSET{ 5, 


2) = 


17 


JSET(5, 


3) = 


38 


JSET{ 5, 


4) = 


45 


JSET( 5, 


5) = 


51 


JSET(5, 


6 ) = 


55 


JSET(5, 


7) = 


60 


JSET( 6, 


1) = 


12 


JSET16, 


2) = 


22 


JSET(6, 


3) = 


47 


JSET( 6, 


4) = 


52 


JSET(6, 


5) = 


56 


JSET(7, 


1) = 


31 


JSET(7, 


2) = 


39 


JSET(7, 


3) = 


57 
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I 



NTAR 



1 



FILTERED AND 


SMOOTHED 


EMITTER 


TARGET DATA 


CORRELATED 


TO NTAR = 


NUM 


FREQ 


PRF 


PW 


THETAD 


THTD 


THTDl 


1 


2872.0 


320.0 


2.40 


59.22729 


59.22729 


59.22729 


2 


2872. 0 


322.0 


2.50 


57.74829 


57.74831 


59.22726 


4 


2872.0 


320.0 


2.50 


56.21729 


56. 12552 


59. 07391 


6 


2872.0 


318.0 


2.40 


55.20752 


55.15414 


59.04889 


7 


2872.0 


320.0 


2.60 


53. 50000 


53.92235 


59. 18648 


9 


2872.0 


319.0 


2.20 


52.58545 


52.52164 


59. 16264 


10 


2872. 0 


321.0 


2.50 


51.41602 


51.74019 


59.24341 


14 


2872.0 


320.0 


2.60 


50.83911 


50.47720 


59.14085 


15 


2872.0 


320.0 


2.20 


49.18433 


49.66541 


59.24278 


19 


2872.0 


320.0 


2.40 


47.33032 


47.87863 


59.36894 


28 


2872.0 


319.0 


2.60 


42.34277 


42.75356 


59. 51895 


32 


2872. 0 


319.0 


2.50 


40.59326 


40.52049 


59.50125 


33 


2872.0 


2 20.0 


2.50 


39. 57764 


39.77419 


59. 53 006 


37 


2872.0 


320.0 


2.40 


37.62451 


37.53296 


59.51884 


40 


2872.0 


320.0 


2. 50 


3 5. 72 827 


35.84486 


59.52922 


42 


2872.0 


320.0 


2.50 


34.95166 


35. 12247 


59. 53961 


48 


2872.0 


319.0 


2.30 


30.94019 


31.07832 


59.54620 


53 


2872.0 


323.0 


2. 80 


27.74072 


28. 14043 


59.55690 


54 


2872.0 


320.0 


2.50 


27.65161 


27.75360 


59. 55846 


59 


2872.0 


322.0 


2.50 


24.15063 


24.70815 


59.56096 



1 



SMOOTHED INITIAL BEARING ANGLE = 59.56096 

FILTERED FINAL BEARING ANGLE = 24.70815 

PLANE TRI ANGULATION SOLUTION OF EMITTER LOCATION 
EMITTER LATITUDE = 33.98666N 

EMITTER LONGITUDE =-119.60387W 
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1 




NTAR 



2 



=ILTERED AND 


SMOOTHED 


EMITTER 


TARGET DATA 


CORRELATED 


NUM 


FREQ 


PRF 


PW 


THETAD 


THTD 


3 


2876.0 


306.0 


2.40 


62.38306 


62.38306 


20 


2878.0 


3 04.0 


2.40 


54.09912 


54.09912 


30 


2878.0 


306.0 


2.30 


51. 18555 


51.03105 


35 


2876.0 


306.0 


2.30 


47.98462 


48.03497 


43 


2876. 0 


306.0 


2.40 


46.86255 


46.09224 


44 


2876.0 


306.0 


2.30 


44.97803 


45.39227 


50 


2876. 0 


306.0 


2.50 


41.82764 


43.05530 


61 


2876. 0 


306.0 


2. 30 


38.91406 


38.93793 


65 


2876.0 


306.0 


2.40 


37.89478 


37.80147 



SMOOTHED INITIAL BEARING ANGLE = 62.21768 

FILTERED FINAL BEARING ANGLE = 37.80147 

PLANE TRI ANGULATION SOLUTION OF EMITTER LOCATION 
EMITTER LATITUDE = 34.12234N 

EMITTER LONGITUDE =-119.00533W 



TO NTAR = 2 

THTDl 

62. 38306 
62.38306 
62. 29199 
62.32124 
61.92072 
62. 00427 
62.22186 
62.22676 
62.21768 
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NTAR 



3 



ALTERED AND 


SMOOTHED 


EMITTER 


TARGET DATA 


CORRELATED 


TO NTAR = 


MUM 


FREQ 


PRF 


PW 


THETAD 


THTD 


THTDl 


5 


2846.0 


370.0 


2.30 


76.31836 


76.31836 


76.31836 


18 


2846. 0 


370.0 


2.30 


73.95044 


73.95042 


76.31836 


29 


2846. 0 


370.0 


2.40 


70.27441 


70.56093 


76.49266 


34 


2846.0 


370.0 


2.40 


69.34839 


69. 21106 


76.45313 


41 


2846. 0 


370.0 


2.40 


67.66235 


67.62057 


76.44316 



SMOOTHED INITIAL BEARING ANGLE = 76.44316 

FILTERED FINAL BEARING ANGLE = 67.62057 

PLANE TRI ANGULATION SOLUTION OF EMITTER LOCATION 
EMITTER LATITUDE = 33.81570N 

EMITTER LONGITUDE =-118.15642W 
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NTAR 



4 



FILTERED AND 


SMOOTHED 


EMITTER 


TARGET DATA 


CORRELATED 


TO NTAR = 


NUM 


FREQ 


PRF 


PW 


THETAD 


THTD 


THTDl 


8 


5556.0 


320.0 


1.00 


89.86621 


89. 86621 


89.86621 


13 


5554.0 


640.0 


1.10 


87.79370 


87.79370 


89.86620 


16 


5556.0 


320.0 


1.00 


86.90747 


86.86319 


89. 84418 


46 


5554.0 


640.0 


0.90 


70.83862 


70.91100 


90.19023 


49 


5554. 0 


320.0 


1.00 


69.82910 


69. 76620 


90. 18146 



SMOOTHED INITIAL BEARING ANGLE = 90.18146 

FILTERED FINAL BEARING ANGLE = 69.76620 

PLANE TRI ANGULATION SOLUTION OF EMITTER LOCATION 
EMITTER LATITUDE = 33.25166N 

EMITTER LONGITUDE =-119.49638W 
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NTAR 



5 



FILTERED AND 


SMOOTHED 


EMITTER 


TARGET DATA 


CORRELATED 


TO NTAR = 


NUM 


FREQ 


PRF 


PW 


THETAD 


THTD 


THTDl 


11 


5506. 0 


640.0 


0. 60 


88.41479 


88.41479 


88.41479 


17 


5504.0 


640.0 


0.60 


86.46436 


86.46436 


88.41478 


38 


5504.0 


640.0 


0.60 


76.17920 


76.17416 


88.38852 


45 


5506.0 


640.0 


0.70 


71.79272 


72.21440 


88.49161 


51 


5504. 0 


642.0 


0.60 


68.64087 


69.23541 


88. 57 054 


55 


5504.0 


640.0 


0.60 


66.98291 


66.89281 


88. 56223 


60 


5504.0 


642.0 


0.60 


62.17212 


63.35942 


88. 63921 



SMOOTHED INITIAL BEARING ANGLE = 83.63921 

FILTERED FINAL BEARING ANGLE = 63.35942 

PLANE TRI ANGULATION SOLUTION OF EMITTER LOCATION 
EMITTER LATITUDE = 33.25288N 

EMITTER LONGITUDE =-119.45715W 
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NTAR 



6 



FILTERED AND 


SMOOTHED 


EMITTER 


TARGET DATA 


CORRELATED 


TO NTAR = 


NUM 


FREQ 


PRF 


PW 


THETAD 


THTD 


THTDl 


12 


2876. 0 


359.0 


2.20 


52. 86011 


52.86011 


52.86011 


22 


2876.0 


359.0 


2.20 


44.03979 


44.03979 


52. 86009 


47 


2876. 0 


3 59.0 


o 

• 

C\J 


35.21875 


34.57146 


52.04729 


52 


2874.0 


359.0 


2.40 


32.30957 


32.36740 


52. 05992 


56 


2876.0 


359.0 


2.20 


27.92432 


28.92722 


52.26216 



SMOOTHED INITIAL BEARING ANGLE = 52.26216 

FILTERED FINAL BEARING ANGLE = 28.92722 

PLANE TRI ANGULATION SOLUTION OF EMITTER LOCATION 
EMITTER LATITUDE = 33.99094N 

EMITTER LONGITUDE =-119.53415W 
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NTAR 



7 



FILTERED AND 


SMOOTHED 


EMITTER 


TARGET DATA 


CORRELATED 


TO NTAR = 


NUM 


FREQ 


PRF 


PW 


THETAD 


THTD 


THTDl 


31 


9268.0 


500.0 


0.20 


48.36182 


48.36182 


48.36182 


39 


9268.0 


499.0 


0.20 


44.31470 


44.31470 


48.36180 


57 


9270.0 


500.0 


0.30 


37. 82275 


37. 71735 


48.22450 



SMOOTHED INITIAL BEARING ANGLE = 48.22450 

FILTERED FINAL BEARING ANGLE = 37.71735 

PLANE TRI ANGULATION SOLUTION OF EMITTER LOCATION 
EMITTER LATITUDE = 34.14626N 

EMITTER LONGITUDE =-119.10936W 
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MONTE CAI^LO SIMULATION COMPUTER OUTPUT 
LISTING OF BEARING ANGLES-OF-ARR! VAL AND AIRCRAFT NAVIGATION DATA 



N HDGDIN) 



SLAD(N) SLOD(N) BRNGD(N) THETAD(N) THETA(N) 



1 180.00000 
2 180.00000 

3 180.00000 

4 180.00000 

5 180.00000 

6 180.00000 

7 180.00000 

8 180.00000 

9 180.00000 

10 180.00000 
11 180.00000 
12 180.00000 

13 180.00000 

14 180.00000 

15 180.00000 

16 180.00000 

17 180.00000 

18 180.00000 

19 180 . 00000 

20 180.00000 
21 180.00000 
22 180.00000 

23 180.00000 

24 180.00000 

25 180.00000 

26 180 . 00000 

27 180.00000 

28 180.00000 

29 180.00000 

30 180.00000 

31 180.00000 

32 180.00000 

33 180.00000 

34 180.00000 

35 180.00000 

36 180.00000 

37 180.00000 

38 180.00000 

39 180.00000 

40 180.00000 

41 180.00000 

42 180.00000 

43 180.00000 

44 180.00000 

45 180.00000 

46 180.00000 

47 180.00000 

48 180.00000 

49 180.00000 

50 180.00000 

51 180.00000 

52 180.00000 

53 180.00000 

54 180.00000 

55 180.00000 

56 180.00000 

57 180.00000 

58 180.00000 

59 180.00000 

60 180.00000 
61 180.00000 



33.50000 - 
33.48332 - 
33.46666 - 
33.45000 - 
33.43332 - 
33.41666 - 
33.39999 - 
33.38332 - 
33.36667 - 
33.34999 - 
33.33333 - 
33.31667 - 
33.29999 - 
33.28333 - 
33.26666 - 
33.25000 - 
33.23332 - 
33.21666 - 
33.20000 - 
33.18332 - 
33.16666 - 
33. 14999 - 
33.13332 - 
33.11667 - 
33.09999 -■ 
33.08333 - 
33.06667 - 
33.04999 - 
33.03333 - 
33.01666 - 
33.00000 - 
32.98332 - 
32.96666 - 
32.95000 - 
32.93332 - 
32.91666 - 
32.89999 - 
32.88332 - 
32.86667 - 
32.84999 - 
32.83333 - 
32.81667 - 
32.79999 - 
32.78333 - 
32.76666 - 
32.75000 - 
32.73332 - 
32.71666 - 
32.70000 - 
32.68332 - 
32,66666 - 
52.64999 - 
32.63332 - 
32.61667 - 
32.59999 - 
32.58333 - 
32.56667 - 
32.54999 - 
32.53333 - 
32.51666 - 

32.50000 - 



118.50000 

118.50000 

116.50000 

118.50000 

118. 50000 

118.50000 

118.50000 

118. 50000 

118.50000 

118.50000 

118. 50000 

118.50000 

118.50000 

118.50000 

118.50000 

118. 50000 

118.50000 

118.50000 

118. 50000 

118.50000 

118.50000 

11 8. 50000 

116.50000 

118.50000 

118. 50000 

118.50000 
118 . 50000 

118.50000 

118.50000 

118. 50000 
118 . 500 C 0 

118.50000 

118. 50000 
118 . 500 C 0 

118.50000 

118.50000 

118.50000 

118. 50000 

118. 50000 

118.50000 

118. 50000 

118.50000 

118.50000 

118.50000 

118.50000 

118.50000 

118. 50000 

118.50000 

118. 50000 

118. 50000 

118.50000 
113 . 50000 

118.50000 

118.50000 

113. 50000 

118.50000 

118.50000 

118.50000 

118.50000 

118.50000 

118. 50000 



105.98349 
123.17577 
104.01610 
121.91071 
102.01436 
120.60915 
99 .98351 
119.27164 
97.92696 
117.89893 
95.84862 
116.49051 
93.75478 
115.04587 
91.65182 
113.56721 
89.54355 
112.05394 
87.43718 
110.50731 
85 .33707 
108.92969 
83.24927 
107 .32155 
81.18033 
105.68427 
79.13434 
104.02003 
77.11496 
102.33228 
75.12862 
100.62157 
73.17722 
98.89243 
71.26514 
97.14586 
69 .39635 
95.35602 
67. 57230 
93.61652 
65.79401 
91.84023 
64.06415 
90. 05963 
62.38416 
88.27945 
60.75365 
86.50214 
59.17412 
84.73131 
57.64409 
82.97147 
56.16422 
81.22481 
54.73453 
79.49355 
53.35355 
77.78148 
52.01973 
76.09212 
50.73351 



105.22139 
122.24252 
104.94077 
122.29161 
102 .36406 
120.92984 
98.88550 
119.94717 
99.29208 
119.21582 
95. 14084 
117. 06377 
94.13567 
116.65103 
92.50012 
112.3473 1 
89.34970 
1 12.10175 
88.07285 
109.82207 
85.69966 
108.74931 
83.28149 
105.82967 
81.26472 
106.09219 
79.86276 
104.02335 
77.43318 
100.94479 
73.85582 
101.37944 
72.90050 
98 . 43813 
72.60910 
96. 18474 
67.66759 
96.01830 
55.77695 
93.04437 
66.04028 
90.44980 
64.31984 
90.87807 
62. 62923 
87.30631 
61.49768 
85.91864 
59.35091 
84.47925 
53.88116 
82.71225 
55.42735 
81 . 17096 
53.34729 
81.11581 
53.391 83 
77. 89078 
52. 08127 
75.29662 
51.08221 



1.83646 
2.13353 
1. 83156 
2. 13439 
1.78659 
2.11062 
1.72588 
2.09347 
1. 73297 
2.08071 
1.66052 
2.04315 
1.64298 
2. 03 594 
1.61443 
1 .96083 
1.55945 
1.95654 
1.53716 
1. 91676 
1.49574 
1.89803 
1. 45354 
1.84708 
1.41834 
1.85166 
1.39387 
1. 81556 
1.35146 
1.76182 
1.28903 
1. 76940 
1.27235 
1.71807 
1.26727 
1.67874 
1.13102 
1.67583 
1.14806 
1.62393 
1 . 15262 
1.57865 
1.12259 
1.58612 
1. 09309 
1.53252 
1. 07334 
1.49956 
1.03587 
1.47444 
1.02767 
1.44360 
0.96739 
1.41670 
0 . 93109 
1.41574 
0.93186 
1.35945 
0.90899 
1 .31417 
0. 89155 
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NTAR 



1 



UNFILTERED EMITTER TARGET DATA INITIALLY ASSOCIATED TO NTAR = 1 

EMITTER BEARING LINES OF SIMILAR FREQUENCY AND PRF OR PRF MULTIPLE 



NUM 


FREQ 


PRF 


PW 


HDGD 


BRMGD 


THETAD 


1 


1197.0 


150.0 


3. 50 


180. 00000 


105. 98349 


105. 22139 


3 


1197.0 


150.0 


3.50 


180.00000 


104.01610 


104. 94077 


5 


1197. 0 


150.0 


3.50 


180.00000 


102.01436 


102.36406 


7 


1197.0 


150.0 


3.50 


180. 00000 


99.98351 


98. 88550 


9 


1197.0 


150.0 


3.50 


180.00000 


97.92696 


99. 29208 


11 


1197. 0 


150.0 


3.50 


180. 00000 


95.84862 


95.14084 


13 


1197.0 


150.0 


3.50 


180. 00000 


93. 75478 


94. 13567 


15 


1197.0 


150.0 


3.50 


180.00000 


91.65182 


92. 50012 


17 


1197. 0 


150.0 


3.50 


180. 00000 


89.54355 


89.34970 


19 


1197.0 


150.0 


3.50 


180.00000 


87.43718 


88.07285 


21 


1197.0 


150.0 


3.50 


130.00000 


35.33707 


85. 69966 


23 


1197. 0 


150.0 


3. 50 


180. 00000 


83.24927 


83.28149 


25 


1197.0 


150.0 


3.50 


180.00000 


81.18033 


81. 26472 


27 


1197. 0 


150.0 


3.50 


180.0C000 


79. 13434 


79. 86276 


29 


1197.0 


150.0 


3.50 


180. 00000 


77. 11496 


77.43318 


31 


1197.0 


150.0 


3.50 


180.00000 


75. 12862 


73. 85582 


33 


1197. 0 


150.0 


3.50 


180.00000 


73.17722 


72.90050 


35 


1197.0 


150.0 


3.50 


180.00000 


71. 26514 


72.60910 


37 


1197.0 


150.0 


3.50 


180.00000 


69.39635 


67. 66759 


39 


1197.0 


150.0 


3.50 


180. 00000 


67.57230 


65.77895 


41 


1197.0 


150.0 


3.50 


180.00000 


65.79401 


66. 04 02 8 


43 


1197. 0 


150.0 


3. 50 


180.00000 


64.06415 


64.31984 


45 


1197.0 


150.0 


3.50 


180. 00000 


62.38416 


62.62923 


47 


1197. 0 


150.0 


3.50 


180.00000 


60. 75365 


61.49768 


49 


1197. 0 


150.0 


3.50 


180.00000 


59. 17412 


59.35091 


51 


1197.0 


150.0 


3.50 


180.00000 


57.64409 


58. 88116 


53 


1197. 0 


150.0 


3.50 


180.00000 


56. 16422 


55.42735 


55 


1197. 0 


150.0 


3.50 


130.00000 


54.73453 


53.34729 


57 


1197.0 


150.0 


3.50 


130. 00000 


53.35355 


53.39183 


59 


1197.0 


150.0 


3.50 


180.00000 


52.01973 


52.08127 


61 


1197. 0 


150.0 


3. 50 


180. 00000 


50.73331 


51.08221 
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I 




NTAR 



2 



UNFILTERED EMITTER TARGET DATA INITIALLY ASSOCIATED TO NTAR = 2 

EMITTER BEARING LINES OF SIMILAR FREQUENCY AND PRF OR PRF MULTIPLE 



NUM 


FREQ 


PRF 


PW 


HDGD 


BRNGD 


THETAD 


2 


1212.0 


250.0 


3.00 


180. 00000 


123. 17577 


122.24252 


4 


1212.0 


250.0 


3.00 


180.00000 


121.91071 


122. 29161 


6 


1212. 0 


250.0 


3.00 


180.00000 


120.60915 


120.92984 


8 


1212. 0 


250.0 


3.00 


180.00000 


119. 27164 


119. 94717 


10 


1212.0 


250.0 


3.00 


180.00000 


117.89893 


119.21582 


12 


1212.0 


250.0 


3.00 


180.00000 


116.49051 


117.06377 


14 


1212 .0 


250 .0 


3.00 


130.00000 


115. 04587 


116. 65103 


16 


1212 .0 


250.0 


3.00 


180.00000 


113.56721 


112.34737 


18 


1212.0 


250.0 


3.00 


180. 00000 


112.05394 


112.10175 


20 


1212.0 


250.0 


3.00 


180.00000 


110.50731 


109. 82207 


22 


1212.0 


250.0 


3.00 


130.00000 


108.92969 


108.74931 


24 


1212.0 


250.0 


3. 00 


180. 00000 


107, 32155 


105.82967 


26 


1212.0 


250.0 


3.00 


180.00000 


105. 68427 


106. 09219 


28 


1212. 0 


250.0 


3.00 


180.00000 


104.02003 


104.02385 


30 


1212. 0 


250.0 


3.00 


180. 00000 


102. 33228 


100.94479 


32 


1212.0 


250.0 


3.00 


180.00000 


100.62157 


101. 37944 


34 


1212.0 


250.0 


3.00 


180.00000 


98.89243 


98.43813 


36 


1212.0 


250.0 


3.00 


180.00000 


97. 14586 


96. 18474 


38 


1212.0 


250.0 


3.00 


180.00000 


95.38602 


96. 01830 


40 


1212. 0 


250.0 


3.00 


180. 00000 


93.61652 


93.04437 


42 


1212 .0 


250.0 


3.00 


180.00000 


91. 84023 


90. A4980 


44 


1212. 0 


250.0 


3.00 


180.00000 


90.05968 


90.87807 


46 


1212.0 


250.0 


3. 00 


100. 00000 


88.27945 


87.80681 


48 


1212.0 


250.0 


3.00 


180.00000 


86. 50214 


85.91864 


50 


1212. 0 


250.0 


3.00 


180.00000 


84.73131 


84.47925 


52 


1212.0 


250.0 


3.00 


180. 00000 


82.97147 


82. 71225 


54 


1212 .0 


250.0 


3.00 


180.00000 


31.22481 


81. 17096 


56 


1212. 0 


250.0 


3.00 


180. OCOOO 


79.49355 


81 . 11531 


58 


1212.0 


250.0 


3.00 


180.00000 


77. 78148 


77. 89078 


60 


1212.0 


250.0 


3 .00 


180.00000 


76.09212 


75.29662 
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INITIAL JSET DATA 



JSETd, 1)= 1 
JSETd, 2)= 3 
JSETd, 3)= 5 
JSETd, A)= 7 
JSETd, 5)= 9 
JSETd, 6)= 11 
JSETd, 7)= 13 
JSETd, 8)= 15 
JSETd, 9)= 17 
JSETd, 10)= 19 
JSET( 1, 11)= 21 
JSETd, 12)= 23 
JSETd, 13)= 25 
JSET( 1, 14)= 27 
JSETd, 15)= 29 
JSETd, 16)= 31 
JSETd, 17)= 33 
JSETd, 18)= 35 
JSETd, 19)= 37 
JSET( 1,20)= 39 
JSETd, 21)= 41 
JSETd ,22)= 43 
JSET( 1,23)= 45 
JSETd, 24)= 47 
JSETd, 25)= 49 
JSETd, 26)= 51 
JSETd, 27)= 53 
JSETd ,28)= 55 
JSETd, 29)= 57 
JSETd, 30)= 59 
JSET( 1 ,31) = 61 
JSET(2, 1)= 2 
JSET(2, 2)= 4 
JSET(2, 3)= 6 
JSET(2, 4)= 8 
JSET(2, 5)= 10 
JSET(2, 6)= 12 
JSET(2, 7)= 14 
JSET(2, 8)= 16 
JSET(2, 9)= 18 
JSET(2,10)= 20 
JSET(2,11)= 22 
JSET(2,12)= 24 
JSET(2,13)= 26 
JSET(2,14)= 28 
JSET(2,15)= 30 
JSET(2,16)= 32 
JSET(2,17)= 34 
JSET(2,18)= 36 
JSET(2,19)= 38 
JSET (2, 20)= 40 
JSET(2,21)= 42 
JSET(2,22)= 44 
JSET(2,23)= 46 
JSET(2,24)= 48 
JSET(2,25)= 50 
JSET(2,26)= 52 
JSET(2,27)= 54 
JSET(2,28)= 56 
JSET(2,29)= 58 
JSET(2,30)= 60 
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LISTING OF KALMAN FILTER PARAMETERS 



I 


J 


KK 


K 


GKK ) 


G2 ( K ) 


T ( K ) 


E ( K ) 


GATE ( K ) 


1 


1 


0 


1 


0.99010 


0.0 


0.0 






1 


2 


1 


3 


0.99993 


0.08332 


12. 00000 


- 0.25723 


360 . 02466 


1 


3 


3 


5 


0.83379 


0.04173 


12.00000 


- 2. 29614 


7.35863 


1 


4 


5 


7 


0.70240 


0.02544 


12.00000 


- 2.42987 


5.49924 


1 


5 


7 


9 


0.60715 


0.0176 1 


12. 00000 


1.85547 


4. 78637 


1 


6 


9 


11 


0.53905 


0.01346 


12.00000 


- 1.64236 


4.41870 


1 


7 


11 


13 


0.49142 


0.01125 


12.00000 


0.28345 


4.20671 


1 


8 


13 


15 


0.45945 


0.01007 


12.00000 


0.51604 


4. 08039 


1 


9 


15 


17 


0.43927 


0.00949 


12.00000 


- 0.92641 


4.00630 


1 


10 


17 


19 


0.42756 


0 . 00924 


12. 00000 


0.25426 


3.96513 


1 


11 


19 


21 


0.42147 


0.00916 


12.00000 


- 0. 20528 


3.94418 


1 


12 


21 


23 


0.41871 


0.00915 


12.00000 


- 0.49200 


3.93481 


1 


13 


23 


25 


0 . 41768 


0.00916 


12. 00000 


- 0.20381 


3 . 93134 


1 


14 


25 


27 


0.41740 


0.00917 


12.00000 


0 . 60071 


3.93040 


1 


15 


27 


29 


0.41737 


0.00917 


12.00000 


- 0.02434 


3.93028 


1 


16 


29 


31 


0.41737 


0.00917 


12.00000 


- 1 . 53360 


3 . 93028 


1 


17 


31 


33 


0.41734 


0.00917 


12.00000 


0.37788 


3.93019 


1 


18 


33 


35 


0.41729 


0. 00917 


12. 00000 


2. 11394 


3.93004 


1 


19 


35 


37 


0.41724 


0.00916 


12.00000 


- 1. 75706 


3.92 987 


1 


20 


37 


39 


0.41720 


0.00916 


12.00000 


- 0.76671 


3.92973 


1 


21 


39 


41 


0.41718 


0. 00916 


12. 00000 


2.04466 


3.92964 


1 


22 


41 


43 


0.41716 


0.00916 


12.00000 


1.47659 


3.92957 


1 


23 


43 


45 


0.41715 


0.00916 


12.00000 


1.01303 


3.92955 


1 


24 


45 


47 


0.41715 


0. 00916 


12. 00000 


1.19057 


3. 92953 


1 


25 


47 


49 


0.41714 


0.00916 


12.00000 


0. 14793 


3.92953 


1 


26 


49 


51 


0.41714 


0.00916 


12.00000 


1.20099 


3.92953 


1 


27 


51 


53 


0.41714 


0.00916 


12. 00000 


- 1. 30133 


3 . 92953 


1 


28 


53 


55 


0.41714 


0.00916 


12.00000 


- 1.24301 


3.92953 


1 


29 


55 


57 


0.41714 


0. 00916 


12.00000 


1.05223 


3.92953 


1 


30 


57 


59 


0.41714 


0.00916 


12. 00000 


0 . 91925 


3.92953 


1 


31 


59 


61 


0.41714 


0.00916 


12.00000 


1.05219 


3.92953 


2 


1 


0 


2 


0.99010 


0 . 0 


0.0 






2 


2 


2 


4 


0.99993 


0.08332 


12 . 00000 


0 . 06944 


360.02466 


2 


3 


4 


6 


0. 83379 


0.04173 


12.00000 


- 1.41083 


7.35863 


2 


4 


6 


8 


0.70240 


0. 02544 


12. 00000 


- 0 . 55978 


5 . 49924 


2 


5 


8 


10 


0.60715 


0.01761 


12.00000 


- 0.06970 


4 . 78657 


2 


6 


10 


12 


0. 53905 


0.01348 


12.00000 


- 1.33647 


4.41870 


2 


7 


12 


14 


0.49142 


0.01 125 


12.00000 


0.03041 


4 . 20671 


2 


8 . 


14 


16 


0.45945 


0.01007 


12.00000 


- 3.23311 


4. 08039 


2 


9 


16 


18 


C . 43927 


0. 00949 


12.00000 


- 0 .54752 


4.00630 


2 


10 


18 


20 


0.42756 


0.00924 


12. 00000 


- 1. 07857 


3.96513 


2 


11 


20 


22 


0.42147 


0.00916 


12.00000 


- 0.06239 


3.94418 


2 


12 


22 


24 


0.41871 


0. 00915 


12. 00000 


- 1.32112 


3.93481 


2 


13 


24 


26 


0.41768 


0.00916 


12. 00000 


1.27428 


3.93134 


2 


14 


26 


28 


0.41740 


0.00917 


12.00000 


0.31332 


3.93040 


2 


15 


28 


30 


0.41737 


0. 00917 


12. 00000 


- 1.29135 


3.93028 


2 


16 


30 


32 


0.41737 


0.00917 


12.00000 


1.42955 


3 . 93028 


2 


17 


32 


34 


0.41734 


0.00917 


12.00000 


- 0.51846 


3.93019 


2 


18 


34 


36 


0.41729 


0.00917 


12.00000 


- 0.90848 


3.93004 


2 


19 


36 


38 


0.41724 


0.00916 


12.00000 


1.05110 


3 . 92°87 


2 


20 


38 


40 


0.41720 


0.00916 


12.00000 


- 0.73004 


3.92973 


2 


21 


40 


42 


0.41718 


0.00916 


12. 00000 


- 1.30844 


3.92964 


2 


22 


42 


44 


0.41716 


0.00916 


12.00000 


1.52113 


3.92957 


2 


23 


44 


46 


0.41715 


0. 00916 


12. 00000 


- 0.49646 


3.92955 


2 


24 


46 


48 


0.41715 


0.00916 


12.00000 


- 0.43472 


3. 92953 


2 


25 


48 


50 


0.41714 


0.00916 


12.00000 


0.09782 


3.92953 


2 


26 


50 


52 


0.41714 


0. 00916 


12.00000 


0.06985 


3. 92953 


2 


27 


52 


54 


0.41714 


0.00916 


12.00000 


0.27159 


3.92953 


2 


28 


54 


56 


0.41714 


0. 00916 


12.00000 


1.84546 


3.92953 


2 


29 


56 


58 


0.41714 


0.00916 


12. 00000 


- 0.60997 


. 3.92953 


2 


30 


58 


60 


0.41714 


0.00916 


12.00000 


- 1.34320 


3.92953 
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FINAL JSET DATA 



JSETd, 1)= 1 
JSETd, 2)= 3 
JSETd, 3)= 5 
JSETd, 4)= 7 
JSETd, 5)= 9 
JSETd, 6)= 11 
JSETd, 7)= 13 
JSETd, 8)= 15 
JSETd, 9)= 17 
JSETd, 10)= 19 
JSETd, 11)= 21 
JSETd, 12)= 23 
JSETd, 13)= 25 
JSETd, 14)= 27 
JSETd, 15)= 29 
JSETd, 16)= 31 
JSETd, 17)= 33 
JSET( 1,18)= 35 
JSETd, 19)= 37 
JSETd, 20)= 39 
JSET( 1,21)= 41 
JSETd, 22)= 43 
JSETd, 23)= 45 
JSET( 1,24)= 47 
JSETd, 25)= 49 
JSETd ,26)= 51 
JSETd, 27)= 53 
JSETd, 28)= 55 
JSETd, 29)= 57 
JSET( 1,30)= 59 
JSETd, 31)= 61 
JSETt2, 1)= 2 
JSET(2, 2)= 4 
JSET(2, 3)= 6 
JSET(2, 4)= 8 
JSET(2, 5)= 10 
JSET(2, 6)= 12 
JSET(2, 7)= 14 
JSET(2, 8)= 16 
JSET(2, 9)= 18 
JSET(2,10)= 20 
JSET(2,11)= 22 
JSET(2,12)= 24 
JSET(2, 13)= 26 
JSET(2,14)= 28 
JSET(2,15)= 30 
JSET( 2,16)= 32 
JSET(2,17)= 34 
JSET(2,18)= 36 
JSET(2,19)= 38 
JSET(2,20)= 40 
JSET(2,21)= 42 
JSET(2,22)= 44 
JSET(2,23)= 46 
JSET(2,24)= 48 
JSET(2,25)= 50 
JSET(2,26)= 52 
JSET(2,27)= 54 
JSET(2,28)= 56 
JSET(2,29)= 58 
JSET(2,30)= 60 
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NTAR 



1 



FILTERED AND SMOOTHED EMITTER TARGET DATA CORRELATED TO NTAR = 1 



NUM 


FREQ 


PRF 


PW 


THETAD 


THTD 


THTDl 


1 


1197. 0 


150.0 


3.50 


105.22139 


105.22139 


105.22139 


3 


1197.0 


150.0 


3. 50 


104.94077 


104.94078 


105.22136 


5 


1197.0 


150,0 


3.50 


102.36406 


102.74568 


105.59840 


7 


1197. 0 


150.0 


3.50 


98.88550 


99.60863 


106.07678 


9 


1197. 0 


150.0 


3. 50 


99.29208 


98. 56316 


105.71794 


11 


1197.0 


150.0 


3.50 


95. 14084 


95.89789 


106. 00923 


13 


1197. 0 


150.0 


3.50 


94.13567 


93.99150 


105.96504 


15 


1197.0 


150.0 


3. 50 


92. 50012 


92. 22116 


105. 89708 


17 


1197.0 


150.0 


3.50 


89.34970 


89.86916 


105.99577 


19 


1197. 0 


150.0 


3.50 


88.07285 


87.92729 


105.97491 


21 


1197.0 


150.0 


3.50 


85.69966 


85. 81842 


105.98711 


23 


1197. 0 


150.0 


3.50 


83.28149 


83.56749 


106. 00682 


25 


1197. 0 


150.0 


3. 50 


81. 26472 


81.38341 


106.01180 


27 


1197.0 


150 .0 


3.50 


79. 86276 


79.51279 


106. 00418 


29 


1197. 0 


150.0 


3.50 


77.43318 


77.44736 


106.00429 


31 


1197.0 


150.0 


3. 50 


73.85582 


74.74934 


106.00293 


33 


1197.0 


150.0 


3.50 


72.90050 


72.68031 


106.00438 


35 


1197. 0 


150.0 


3.50 


72.60910 


71.37729 


106.01534 


37 


1197. 0 


150.0 


3. 50 


6 7.66759 


68.69151 


106. 00587 


39 


1197.0 


150.0 


3.50 


65.77895 


66.22577 


106. 00211 


41 


1197.0 


150.0 


3.50 


66. 04028 


64.84860 


106.01045 


43 


1197. 0 


150.0 


3.50 


64. 31984 


63.45921 


106. 01512 


45 


1197.0 


150.0 


3.50 


62.62923 


62.03877 


106.01743 


47 


1197.0 


150.0 


3.50 


61.49768 


60. 80374 


106.01921 


49 


1197.0 


150 .0 


3. 50 


59.35091 


59. 26468 


106. 01933 


51 


1197.0 


150.0 


3.50 


58.88116 


58.18115 


106.01985 


53 


1197.0 


150.0 


3.50 


55.42735 


56.18584 


106.01966 


55 


1197.0 


150.0 


3.50 


53.34729 


54. 07178 


106, 01976 


57 


1197. 0 


150.0 


3.50 


53.39183 


52.77852 


106. 01956 


59 


1197.0 


150.0 


3. 50 


52. 08127 


51. 54547 


106.01935 


61 


1197.0 


150.0 


3.50 


51.08221 


50.46893 


106. 01910 



SMOOTHED INITIAL BEARING ANGLE = 106.01910 
FILTERED FINAL BEARING ANGLE = 50.46893 

PLANE TRI ANGULATION SOLUTION OF EMITTER LOCATION 
EMITTER LATITUDE = 33.24187N 

EMITTER LONGITUDE =-117.42503W 
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NTAR 



2 



FILTERED AND SMOOTHED EMITTER TARGET DATA CORRELATED TO NTAR = 2 



NUM 


FREQ 


PRF 


PW 


THETAD 


THTD 


THTDl 


2 


1212.0 


250.0 


3.00 


122. 242.52 


122. 24252 


122.24252 


4 


1212.0 


250.0 


3.00 


122.29161 


122.29160 


122. 24252 


6 


1212. 0 


250.0 


3.00 


120.92984 


121. 16432 


122.47420 


8 


1212.0 


250.0 


3.00 


119.94717 


120. 11375 


122. 58440 


10 


1212.0 


250.0 


3.00 


119.21582 


119.24319 


122.59787 


12 


1212.0 


250.0 


3.00 


117.06377 


117.67981 


122.83490 


14 


1212.0 


250.0 


3.00 


116.65103 


116. 63556 


122. 83015 


16 


1212.0 


250.0 


3.00 


1 12.34737 


114.09503 


123.25594 


18 


1212.0 


250.0 


3.00 


112. 10175 


112.40875 


123.31427 


20 


1212.0 


250.0 


3.00 


109.82207 


110.43947 


123.40269 


22 


1212.0 


250.0 


3.00 


108.74931 


108.76540 


123.40640 


24 


1212.0 


250.0 


3.00 


105. 82967 


106. 59761 


123. 45934 


26 


1212.0 


250.0 


3.00 


106.09219 


105.35014 


123.42816 


28 


1212.0 


250.0 


3.00 


104.02385 


103.84129 


123.42418 


30 


1212.0 


250.0 


3.00 


100.94479 


101. 69717 


123. 42987 


32 


1212.0 


250.0 


3.00 


101.37944 


100.54652 


123.43112 


34 


1212. 0 


250.0 


3.00 


98.43813 


98.74020 


123.42911 


36 


1212.0 


250.0 


3.00 


96. 18474 


96.71411 


123. 42439 


38 


1212.0 


250.0 


3.00 


96.01830 


95.40575 


123.43004 


40 


1212.0 


250.0 


3.00 


93. 04437 


93.46933 


123.42645 


42 


1212.0 


250.0 


3.00 


90.44980 


91.21239 


123.42110 


44 


1212. 0 


250.0 


3.00 


90.87807 


89.99149 


123.42590 


46 


1212.0 


250.0 


3. 00 


87.80681 


88.09616 


123.42477 


48 


1212.0 


250.0 


3.00 


85.91864 


86. 17201 


123.42412 


50 


1212. 0 


250.0 


3.00 


84.47925 


84.42223 


123.42419 


52 


1212.0 


250.0 


3.00 


82.71225 


82.67152 


123.42422 


54 


1212.0 


250.0 


3.00 


81.17096 


81.01265 


123.42426 


56 


1212.0 


250.0 


3.00 


81.11581 


80.04016 


123.42412 


58 


1212.0 


250.0 


3.00 


77. 89078 


78. 24629 


123. 42422 


60 


1212.0 


250.0 


3.00 


75.29662 


76. 07950 


123.42451 



SMOOTHED INITIAL BEARING ANGLE = 123.42A51 
FILTERED FINAL BEARING ANGLE = 76.07950 

PLANE TRI ANGULATION SOLUTION OF EMITTER LOCATION 
EMITTER LATITUDE = 32 .78056N 

EMITTER LONGITUDE =-117.23346W 
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5jc 5{? 5{< 3^ 5}: :}c sit >{; sji s*c jjc 3}: :»c s;; 5|t 35: :^c ^ sjc s;? ;{c ?}c ;{c 5|c 

sjc /* 

* KALMAN FILTER PROGRAM TO ESTIMATE EMITTER LOCATION « 

* FROM FILTERED BEARING ANG LES-OF-ARR I VAL 

<JU 

*»' 
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THIS FORTRAN PROGRAM IS DESIGNED TO ANALYZE AND SORT 
ELECTRONIC EMITTER PARAMETERS AND AIRCRAFT NAVIGATION 
DATA, TO FILTER EMITTER DATA USING KALMAN FILTER TECH- 
NIQUES TO MINIMIZE BEARING AN GLE-OF- ARR I VAL MEASUREMENT 
NOISE, TO SMOOTH INITIAL UNFILTERED BEARING ANGLES, 

AND TO PREDICT EMITTER LOCATIONS USING TRI ANGULATI ON 
METHODS 

DIMENSION ALT ( 100) ,BRNG( 100) ,BRNGD( 100) ,D11 ( 100) , 
1D12(100) ,D21( 100) , D22{ 100) ,E( 100) , FREQ( 100) ,Gi{ 100) , 
2G2( 100) ,GAT£ tlOO) ,HDG( 100) , HDGO ( 100 ) , JSET ( 30 , 50 ) , LW { 2) 
3M0DEN( 100) ,MODET( 100) , MW ( 2 ) ,NST ( 100 ) ,P11 { IOC) , PI 2 { 100) 
4P22(100) ,PIN(2,2) , PINIU 100) ,PIN12{ 100),PIN22( 100) , 
5PITCH( iOC) ,PRF( LOO) ,PW(100) ,Q11 <100) ,Q12(100) ,Q22(100) 
6QP11 ( 100) ,QP12(100) ,0P21( 100) ,QP22( 100) ,R( 100) ,RB( 100) 
TROLL (ICO) , SLA (100) ,SLAD( 100 ) , SLO { 100 ) , SLOD( 100) ,T( 100) 
BTTdOO) , TAT (100) ,TIMEN(100) ,TIMET(100) ,TDT(100), 

9TDTD( 100) ,TDTD1 ( 100) ,THT( 1 00 ) , TH TD ( 1 00 ) ,THT1( 100) , 
OTHTDK 100) ,TPT(100) , TPTD ( 1 00 ) , TH ET A ( 100 ) ,THETAD( 100) , 
1TILA( 10) ,TLA( 10) ,TLAD( 10) ,TLO( 10) ,TL0D(10) ,VEL(100) , 
2VELE(100) ,VELN( 100 ) , WAV( 100) 

SUBROUTINE TO READ EMITTER TARGET AND AIRCRAFT 
NAVIGATION DATA FROM CARD DATA DECK 
DATA SEQUENCE MUST BE OF FORMAT TGT/NAV 

NUM=65 

DO 1 I=1,NUM 

TYPE=11,0 EMITTER TARGET DATA 

R£AD(5 ,51 )TGT, TIMET( I ) , BRNG( I ) ,PRF ( I ) ,MODET( I ) ,PW( I ) , 
1FREQ( I ) 

TYPE=7.0 AIRCRAFT NAVIGATION DATA 

READ (5 ,52) NAV,TIMEM( I ) ,MODEN( I ) ,ALT( I ) , SLA( I ) , SLG( I ) 
READ (5, 56) HDG ( I ) , VELE ( I ) , V ELN ( I ) ,ROLL( I) ,PITCH( I ) 

SUBROUTINE TO COMPUTE AIRCRAFT VELOCITY 

VELS=VELE(I)-*2+VELN(I )=;==^2 
VEU I)-SQRT(VELS) 

1 CONTINUE 

SUBROUTINE TO CHANGE ANGLES AND LATI TUDE /LONG I TUDE 
FROM RADIANS TO DEGREES + TENTHS OF DEGREES 

WRITE(6,57) 

DO 5 J=1,NUM 
PIRAD=57» 29578 
HOGD(J )=HDG( J)-PIRAD 
BRNGD( J)=BRNG( J)=f^PIRAD 
SLAD(J)=SLA( J)*PIRAD 
SLOO( J )=SLO(J)*PIRAO 
THETA( J) =BRNG( J)+HCG(J) 

IF(TH£TA( J ) .GT. 6. 2 83 186) THETA ( J ) =THET A ( J ) -6 .2831 86 
THETAD( J)=BRNGD( J )+HDGD( J ) 

IF(THETAD(J) .GT. 360.0) THET AD ( J ) =T HET AD( J ) -3 60 . 0 
WRITE ( 6, 58) J ,HDGD( J) ,SLAD( J) ,SLOD( J) ,BRNGD( J) , 
ITHETAD(J) ,THETA( J) 

5 CONTINUE 
C 
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C PROGRAM TO SORT EMITTER TARGET DATA AND ESTIMATE NUMBER 
C OF DISTINCT EMITTER TARGETS 

C DATA IS INITIALLY SORTED BY FREQUENCY AND PRF 
C 

NTAR=0 

DO 10 1=1, NUM 

IF( I .EQ.l) GO TO 19 

L=I-1 

DO 18 KQ=1,L 
M=I-KQ 

DELTF=FREQ( I )-FREQ(M) 

DELTPR=PRF ( I )-PRF( M) 

IF(ABS(DELTF).LE.4.0,AND.ABS(DELTPR) .LE.4.0) GO TO 10 

CHECK FOR MULTIPLES OF PRF 

IF(ABS(DELTF).GT.4.0) GO TO 18 

DO 11 N=2,5 

RK=N^PRF(M) 

SK=PRF ( I ) 

TK=PRF (M) /FLOAT! N) 

CK=ABS( RK-SK) 

DK=ABS(TK-SK) 

FK=M«4. 0 

IF(CK.LT .FK.OR.dk. LT.FK) GO TO 10 

11 CONTINUE 

18 CONTINUE 

19 NTAR=NTAR+1 
WRITE(6,59)NTAR 
WRITE! 6,61)NTAR 
NJ = 1 

JSET! NTAR,NJ) =I 

DO 13 J=1,NUM 

IF! J .EQ. I ) GO TO 13 

DELF=FREO!J}-FREQ! I ) 

DELPRF = PRF ( J)-PRF! 1 ) 

IF!ABS!DELF) .LE.4.0) GO TO 4 
GO TO 13 

CHECK FOR SUBSEQUENT MULTIPLES OF PRF 

4 DO 12 N=l,5 
RK=N^'=PRF!J ) 

SK=PRF ! I ) 

TK=PRF !J) /FLOAT! N) 

CK=ABS! RK-SK) 

DK=ABS !TK-SK) 

FK=N^4.0 

IF!CK. LT.FK.OR.dk. LT.FK) GO TO 14 

12 CONTINUE 
GO TO 13 

14 NJ=NJ+1 
JSET!NTAR,NJ)=J 

13 CONTINUE 
NST! NTAR)=NJ 
NSTA=NST!NTAR) 

IF!NSTA.EQ. 1.0) GO TO 17 

SUBROUTINE TO CHECK FOR AND ELIMINATE 360 DEGREE 
VARIATION IN EMITTER BEARING ANGLE THETA 

DO 9 J=2,NSTA 
JM=J-1 

KK=JSET!NTAR, JM) 

K=JSET !NTAR, J ) 

IF ! THETAD! KK) . LT.10.0. AND.THETADIK ) .GT .350 .0 ) GO TO 15 
IF!THETAD(KK).GT. 350.0. AND. THETAD!K).LT. 10.0) GO TO 16 
GO TO 9 

15 DO 6 MM=1,JM 
M=JSET ! MTAR,MM ) 

THETAD!M)=THETAD!M) +360.0 
THETA! M) =THE TA ! M ) +6 . 283 1 36 
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6 CONTINUE 
GO TO 17 

16 DO 7 MN=J,NSTA 
M=JSET(MTAR,MN) 

THETAD(M)=THETAD(M )+360.0 
THETA (M) =THETA(M)+6.283186 

7 CONTINUE 
GO TO 17 

9 CONTINUE 

PRINT UNFILTERED BEARING LINES OF SIMILAR 
FREQUENCY AND PRF 

17 DO 8 J=1,NSTA 
K=JSET(NTAR, J) 

WRITE! 6,60 )K,FREQ(K) ,PRF(K) , PW ( K ) , HDGD ( K ) ,BRNGD(K) , 
ITHETAD(K) 

8 CONTINUE 
10 CONTINUE 

SUBROUTINE TO COMPUTE INITIAL EMITTER TARGET JSET DATA 

WRITE(6,62) 

DO 25 I=i,NTAR 
NSTA=NST( I ) 

WRITE(6,63)(I, J, JSET( I , J I , J= 1 , NSTA ) 

25 CONTINUE 

PROGRAM TO FILTER NOISY MEASURED BEARING ANGLE THETAD(K) 
AND AIRCRAFT NAVIGATION DATA FOR EACH SUSPECTED EMITTER 
TARGET OF SIMILAR FREQUENCY AND PRF 

INITIALIZATION OF KALMAN FILTER EQUATION PARAMETERS 

WRITE (6, 50) 

DO 20 I=1,NTAR 
KI = JSET( 1,1) 

Pll ( KI )=10000.0 
P12( KI )=0. 0 
P22(KI ) = 10000.0 
Qll ( KI )=0.0 
Q12I K! )=0.0 
Q22(KI )=0.0 
DIKK! )=1.0 
012( KI )=0.0 
D21 ( KI ) = 0e0 
D22I KI )=1.0 
R(KI )=1A4.0 

GKKI )=P11 (KI )/(Pll(K!)+R(KI ) ) 

G2(KI ) = P12 (KI ) / { Pll (KI )+R(KI ) ) 

THTD(K I )=THETAD( KI ) 

THTDKKI )=THETAD(KI ) 

TDTD(KI ) =VEL(K! )«SIN(BRNG( KI ) ) ’('P I RAD/600 000 . 0 
TDTDK KI ) = TDTD(KI ) 

TIKI )=0.0 

K2=0 

K3=l 

WRITE(6,64)I,K3,K2,K1,G1(KI) ,G2(KI ),T(KI) 

START OF KALMAN FILTER PREDICTION PROBLEM 

NSTA=NST( I ) 

DO 21 J=2,NSTA 
22 K=JSETII,J) 

KK=JSET( I , J-1 ) 

TKM1=TIMET(KK) 

T(K)=TIMET(K)-TKM1 
TT(K) =T{K) /lOOO. 0 
Qll(K)=TT(K,)=!==!=4/4.0 
Q12(K)-TT(K)^-=«'2/2.0 
Q22( K) =TT( K)’!==!^2 
R(K)-144.0 
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START OF KALMAN FILTER RECURSION EQUATIONS 

Pll (K)=P11{KK) *{ l.O-GKKK) ) +2 . 0*P 1 2 ( KK ) *T ( K ) - ( P 12 ( KK ) « 
1G1(KK)+P11 (KK)*G2(KK) )»T(K)+(P22(KK)-P12(KK)*G2(KK) )* 
2T(K)**2+Q11(K) 

P12(K)=P12(KK)*( 1.0-GllKK) ) -K P 2 2 ( KK ) -P 12 ( KK ) *G2 ( KK ) )* 
1T(K)+Q12(K) 

P22(K)=P22(KK)-P12(KK) *G2( KK)+Q22( K) 

G1 (K)=P11 <KJ/{Pil(K)+R{K)) 

G2(K)=P12{K)/(P11(K)+R(K)) 

TPTDI K)=THTD(KK )+TDTD(KK)*T(K) 

E( K)=THETAD(K)-TPTD(K) 

THTD(K)=TPTDI K)^-G1 (K)*E(K) 

TDTDIK )=TDTD(KK)+G2(K)«E(K) 

SMOOTHING EQUATIONS FOR FIRST BEARING LINE ESTIMATE 

PIN( 1 , 1)=P11 (KJ 
PIN( 1,2)=P12(K) 

PINI2, 1)=P12(K) 

PIN(2,2)=P22(K) 

CALL M I NV ( P I N , 2 , DET , LW , MW J 
PIN11(KJ=PIN(1, 1) 

PIN12(K)=PIM(1,2) 

PIN22( K ) = PIN(2, 2) 

QPll (K)=Q11(K)*PIN11 (K )+Q12(K) ’^PIN12(K) 
QP12(K)=Qll(K)=!'-P!N12(K)+Oi2(K)*PIN22(K) 

QP21 (K ) = Q12(K) *PIN11(K ) + Q22(K)=^-PIN12{K) 
QP22(K)=Q12(K)*P!N12{K)+Q22(K)*PIN22(K) 

Dll(K) =D11(KK)»;M 1. 0-QPll (K) ) -0 1 2 ( KK) »:=QP2 1 ( K ) +D1 1 ( KK ) 
1QP21 (K )*T(K) 

D12 (K) =D12(KK)*( 1.0-QP22(K) ) -D1 1 (KK ) *QP 1 2 ( K ) +D 1 1 { KK ) * 
1(QP22( K)-1.0)=^T< KJ 

D21 (K) =D21(KK)*{ 1.0-QPlKK) ) -D22 ( KK ) *QP21 ( K ) +D2 1 ( KK ) =:= 
1QP21 (K)>:^T(K) 

D22IK) =D22(KK)*{ 1. 0-QP22(K) )-D21 (KK) *QP12 ( K J +021 ( KK) * 

1 (QP22 (K)-l .0)=i^T(K) 

THTDK K) =THTD1 (KK) + (D1 1 { K ) *GI ( K ) +D 12 ( K ) *G2 ( K ) )*E(K) 
TDT01(K)=TDTD1(KK) + (D21(K)=:=G1(K)+D22(K)*G2(K) )=!=E(K) 

CORRELATION GATING SCHEME TO ESTIMATE WHETHER FILTERED 
BEARING ANGLE THTD(K) IS AN EMISSION FROM EMITTER TARGET 
NTAR = I OR A SPURIOUS EMISSION 

GATE(K)=SQRT(P11(K)+F (K) )/2.0 

WRITE(6,65 ) I , J ,KK, K, G1 IK ) ,G2(K ) ,T( K) ,E( K) , GATE(K) 
IFIABSIEIK) ) .LT.GATE(K) ) GO TO 21 

THTO(K) IS A SPURIOUS BEARING LINE AND IS DISCARDED 

28 NST( I )=NST( I )-l 
NSTA=NST ( I ) 

IF (NSTA. LT. J) GO TO 20 
DO 27 L=J,NSTA 
JSET{I,L)=JSET(1,L+1) 

27 CONTINUE 
GO TO 22 
21 CONTINUE 

FILTERED BEARING ANGLE THTD(K) IS CORRELATED TO EMITTER 
TARGET NTAR = I 

20 CONTINUE 

SUBROUTINE TO COMPUTE FINAL EMITTER TARGET JSET DATA 

WRITE(6,66) 

DO 30 1=1, NTAR 
NSTA=NST(! ) 

WRITEI6,63) ( I , J, JSET( I , J) , J=1,NSTA) 

30 CONTINUE 
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C PROGRAM TO COMPUTE TARGET POSITION BASED ON A PLANE 
C TRIANGULATION SOLUTION 
C 

DO 35 I=1,NTAR 
WRITE(6,59)I 
WRITE(6»67 J I 
NSTA^NSTI I ) 

KI=JSET( 1,1) 

KF=JSET( I ,NSTA) 

DO 45 J=1,NSTA 
K=JSET( I, J) 

WRITE (6,60)K, FREQI K) ,PRF{K) , PW ( K 1 , THETAD ( K ) ,THTD(K) , 
ITHTDKK) 

45 CONTINUE 

THT(KF)=THTD(KF)/PIRAD 

THTl(KF) =THTD1(KF) /PIRAD 

TATI I )=TAN(THT1(KF) ) -TAN { THT { KF ) ) 

WAV! I)=(SLA(KI )+SLA(KF) )/2 .0 

TILAI I ) = ( { SLO(KF)-SLO(KI )) -COS I WAV I I ) ) +SLAIKI )* 
1TAN(THT1(KF))-SLA(KF)*TAN(THT(KF)) )/TAT{ I) 

TLAI I i =( (SLO(KF)-SLO(KI) ) *COS I T I LA ( I ) ) +SL A ( K I ) 
ITAN(THTIIKF) ) - SLA ( KF ) *TAN I THT I KF ) ) ) /TATI I) 

TLADI 1 )=TLAI I )*PIRAD 

TLOI I }=SLOIKF)-HTLAI I )-SLAIKF) ) '^TANI THT I KF ) )/ 

ICOS ITILAI I ) ) 

TLODI I )=TLO( I )='-PIRAD 
WRITEI6,68)THT01 IKF) ,THTDIKF) 

WRITE(6,70) TLADI I ) ,TLODI I ) 

35 CONTINUE 
C 

50 FORMAT I • 1‘ , 14X, ' LI STING OF KALMAN FILTER PARAMETERS*, 

1//,' I J KK K GlIK) G2IK) TIK) ', 

2'EIK) • ,6X, 'GATEIK) • ,/) 

51 FORMAT I 7F1 1.5) 

52 FORMAT I6F13. 5 ) 

53 FORMAT! * 1* ,36X, ' LI STING OF EMITTER TARGET DATA AND 

1* AIRCRAFT NAVIGATION DATA ',///, 1 3X ,' TARGET PARAMETERS' 
2,37X,' AIRCRAFT PARAMETERS*,//,' TYPE TIME',4X, 

3'FREQ BRNG PRF PW MO / TIME HDG ALT', 

46X,'LAT LONG N.VEL E.VEL ROLL PITCH* 

5,2X, • MO' ,//) 

54 FORMATI' TGT * , I 3 , IX, F9. 3 , 1 X , F6. 1 , 1 X , F7. 5 , 1 X , F6. 1 , IX , 
1F4.2 , IX, II ) 

55 FORMATI* N AV • , 43X , F9 . 3 , 1 X , F7 . 5 , LX , F7 . 1 , IX , F8 . 5 , IX , F 8 . 5 
11X,F8.3,1X,F8.3,1X,F8.5,1X,F8.5,1X,F3.0,/) 

56 FORMAT I5F13. 5 ) 

57 FORMATI *1 LISTING OF BEARING ANG LES-OF-ARR I V AL AND 

I'AIRCRAFT NAVIGATION DATA',///,' N HDGDIN) ', 

2'SLADIN) SLODIN) BRNGDIN) THETADIN) T HETA I N ) ' , / / ) 

58 FORMATI* ’ , I 3 , 4F 1 1 . 5 , F 10 . 5 , F9. 5 ) 

59 FORMAT I • i' ,28X, • MTAR =',I3,//) 

60 FORMAT I ‘G* ,I3,2F8.1,F7.2,3F12.5) 

61 FORMATI '0 UNFILTERED EMITTER TARGET DATA INITIALLY ', 

I'ASSOCIATED TO NTAR =',I3,//,' EMITTER BEARING LINES’, 
2* OF SIMILAR FREQUENCY AND PRF OR PRF MULTIPLE',////, 
3' NUM FREQ PRF PW HDGD BRNGD', 

4* THETAD',/) 

62 FORMATI *1 INITIAL JSET DATA',//) 

63 FORMATI' J SET I » , 1 1 , ' , ' , I 2 , • ) = ' , I 3 ) 

64 FORMAT I • O' ,4I3,4F10.5 ) 

65 FORMAT!' ' ,41 3 , 4F i 0. 5 , FI 2 . 5 ) 

66 FORMATI '1 FINAL JSET DATA',//) 

67 FORMAT I ' OFILTERED AND SMOOTHED EMITTER TARGET DATA ', 

I'CORRELATED TO NTAR =',I2,///,' NUM FREQ PRF', 

2' PW THETAD THTD THTDl',/) 

68 FORMATI ' O' ,//, ' SMOOTHED INITIAL BEARING ANGLE =', 
1F10.5,//,' FILTERED FINAL BEARING ANGLE =',F10.5//) 

70 FORMAT I' 0 PLANE TR I ANGULAT I ON SOLUTION OF EMITTER ', 

1' LOCATION' ,//, ' EMITTER LATITUDE =',F10.5,'N' 

2//,' EMITTER LONGITUDE = ' , F 1 0. 5 , ' W ' ) 

STOP 

END 
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c 

C ^ 

C ^ MONTE CARLO SIMULATION RUN OF KALMAN FILTER PROGRAM 
C * 

«JU *X0 ^»v ^ ^V ^v «v 

>1% j*jK ^v ««|^ ^ >|k --^ -V* ^ ^r ^ ^ ^r* ^ ^ nT' ^ 

c 

C THIS FORTRAN PROGRAM IS DESIGNED TO ANALYZE AND SORT 
C ELECTRONIC EMITTER PARAMETERS AND AIRCRAFT NAVIGATION 
C DATA, TO FILTER EMITTER DATA USING KALMAN FILTER TECH- 
C NIQUES TO MINIMIZE BEARING AN GL E-OF- ARR I VAL MEASUREMENT 

C NOISE, TO SMOOTH INITIAL UNFILTERED BEARING ANGLES, 

C AND TO PREDICT EMITTER LOCATIONS USING TRI ANGULATI ON 
C METHODS 
C 

DIMENSION ALT( 100) , BRNG( 100) ,BRNGD( 100) , Dll ( 100} , 
1D12(100) ,D21( 100), D22I 100} ,£{ 100), FREQ( 100) ,Glt 100) , 
2G2( 100) ,GATE( 100 ) ,HDG(100) ,HDGD( 100 ) , JS ET ( 5 , 40 ) , LW ( 2 ) , 
3M0DEM{ 100) ,MODET( 1 00} , MW I 2 ) , NST { 100 } , PI 1 ( 1 00 ) ,P12( 100) 
4P22( 100) ,PIN{2,2),PIM11( 100),PIN12( 100) , PIN22( 100) , 
5PITCH( 100) ,PRF( 100) , PWdOO } , Q1 1 ( 100 ) , Q12 ( 1 00 } , Q22 (100) 
6QP11 ( 100) ,QP12{ 100) ,0P21( 100) ,QP22{ 100) ,R( 100) ,RB{ 100) 
TROLL (100) ,SLA( 100 ) , SLAD( 100 ) , SLO ( 100 ) , SLOD ( 1 00 ) , T ( 100) 
BTTdOO) ,TAT(100) ,TIMEN(100) ,TIHET(100) ,TDT(100), 

9TDTDI 100 ) ,TDTD1( 100) , T H T ( 1 00 ) , TH TD ( 1 00 ) , THT 1 { 1 00 ) , 
OTHTDK 100) ,TPT (100) ,TPTD{ 100), THETA ( 100 ) ,THETAD( 100) , 
1TILA( B ) ,TLA( 5) ,TLAD( 5) ,TLO( 5) ,TL0D(5) ,VEL( 100) , 
2VELE(100),VELN(100),WAV( 100) 

SUBROUTINE TO READ EMITTER TARGET AND AIRCRAFT 
NAVIGATION DATA FROM CARD DATA DECK 
DATA SEQUENCE MUST BE OF FORMAT TGT/NAV 

NUM=61 
IX=1257 
STDEV= 1.0 
AVE=0.0 
WRITE(6,48) 

DO 1 I=1,NUM 

READ EMITTER TARGET DATA 

READ(5, 51) TGT, TIMET ( I ) ,BRNGD( I ) , PR F ( I ) , P W ( I ) , FRE Q ( I ) 
READ AIRCRAFT NAVIGATION DATA 

READ(5 ,51 )HDGD( I ), SLADI I ) ,SLOD( I ), ALT( I ) , VELN( I ) , 
IVELEI I ) 

GENERATE RANDOM NOISE TO ADD TO KNOWN EMITTER BEARING 
ANGLES OF ARRIVAL 

CALL GAUSS(IX,STDEV,AVE,V) 

THETAD( I )=BRNGD( I )+V 

2 WRITE(6,49)I ,TIMET( I } ,FREQ( I) ,PRF( I ) ,PW( I ) ,BRNGD( I ) , 
1V,THETAD( I ) ,HDGD( I ) ,SLAD( I ) , SLOD ( I ) , ALT ( I ) , V ELN ( I } , 
2VELE( I ) 

SUBROUTINE TO COMPUTE AIRCRAFT VELOCITY 

VELS = VELE( I }'-=<=2+VELN( I 
VEL( I ) =SQRT( VELS ) 

1 CONTINUE 

SUBROUTINE TO CHANGE ANGLES FROM DEGREES TO RADIANS 

WRITE! 6, 57) 

DU 5 J=1,NUM 
PIRAO=57. 29578 
HDGI J)=HDGD( J)/PIRAD 
BRNG( J }=6RNGD( J }/PIRAD 
SLA( J) =SLAD( J) /PIRAD 
SLO( J)=SLOD(J)/PIRAO 
THETA( J }=THETAD( J ) /P IRAD 
RB(J)=BRNG( J)-HDG( J) 

IF(THETA(J } .GT. 6.283 186) THETA ( J ) =THETA ( J ) -6. 2831 86 
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IF {THETADC J ) .GT.360.0 ) T MET ADI J )=THETAD{ J ) -360.0 
WRITEI6,58) JtHDGDI J) ,SLAD{J) ,SL0D(J) ,BRNGDIJ), 
ITHETAD(J), THETA! J) 

5 CONTINUE 
C 

C PROGRAM TO SORT EMITTER TARGET DATA AND ESTIMATE NUMBER 
C OF DISTINCT EMITTER TARGETS 

C DATA IS INITIALLY SORTED BY FREQUENCY AND PRF 
C 

NTAR=0 

DO 10 I=1,NUM 

IF(I .EQ.l j GO TO 19 

L=I-1 

DO 18 KQ=1,L 
M=I-KQ 

DELTF=FREQm^FREQ(M) 

DELTPR=PRFI I )-PRFIM) 

IF(ABS(DELTF).LE.4.0.AND.ABS(DELTPR) .LE.4.0) GO TO 10 
C 

C CHECK FOR MULTIPLES OF PRF 
C 

IF! ABS (DELTF) .GT.4.0) GO TO 18 
DO 11 N=2»5 
RK=N*PRF (M) 

SK=PRF( I ) 

TK=PRF IM)/FLOAT(N) 

CK=ABS(RK-SK) 

DK=ABS ITK-SK) 

FK=N*4.0 

IFICK.LT.FK.OR.DK.LT.FK) GO TO 10 

11 CONTINUE 

18 CONTINUE 

19 NTAR=NTAR+1 
WRITE(6,59>NTAR 
WRITEI6,61)NTAR 
NJ = 1 

JSET (NTAR,NJ)=I 
DO 13 J=1,NUM 
IFIJ.EQ.li GO TO 13 
DELF=FREQ(J)-FREQl i ) 

DELPRF=PRF IJ)-PRF ( I ) 

IFIABSIDELF) .LE.4. 0) GO TO 4 
GO TO 13 
C 

C CHECK FOR SUBSEQUENT MULTIPLES OF PRF 
C 

4 DO 12 N=l,5 
RK=N^PRF IJ) 

SK=PRF{ I ) 

TK=PRF I J)/FLOAT(N) 

CK=ABSIRK-SK) 

DK=ABS (TK-SK) 

FK=N--:'4.0 

IFICK.LT.FK.OR.DK.LT.FK) GO TO 14 

12 CONTINUE 
GO TO 13 

14 NJ=NJ+1 

JSET INTAR, NJ)=J 

13 CONTINUE 
NSTIMTAR)=NJ 
NSTA=NST INTAR) 

IFINSTA.EQ.1.0) GO TO 17 

C 

C SUBROUTINE TO CHECK FOR AND ELIMINATE 360 DEGREE 
C VARIATION IN EMITTER BEARING ANGLE THETA 
C 

DO 9 J=2,NSTA 
JM=J-1 

KK=JSETINTAR, JM) 

K=JSETINTAR, J ) 

IFITHETADIKK) .LT .10.0. AND. THETADIK ) .GT. 350.0) GO TO 15 
IFITHETADIKK).GT. 350.0. AND. THETADIK).LT. 10.0) GO TO 16 
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GO TO 9 
DO 6 MM=1 , JM 
M=JSET(NTAR,MM) 

THETAD(M)=THETAD(M)+360.0 
THETA(M)=THETA(M)+6.283186 

6 • CONTINUE 

GO TO 17 

16 DO 7 MN=J,NSTA 
M=JSET(NTAR,MN) 

THETAD(M)=THETAD(M )+360. 0 
THETA(M)=THETA(M)+6.283186 

7 CONTINUE 
GO TO 17 

9 CONTINUE 
C 

C PRINT UNFILTERED BEARING LINES OF SIMILAR 
C FREQUENCY AND PRF 
C 

17 DO 8 J=1,NSTA 
K=JSET( NTAR, J) 

WRITE! 6t60)K,FREQ( K) ,PRF(K) t PW ( K ) , HDGD ( K ) ,BRNGD(K) , 
ITHETAD(K) 

8 CONTINUE 
10 CONTINUE 

r 

C SUBROUTINE TO COMPUTE INITIAL EMITTER TARGET JSET DATA 
C 

WRITE(6,62) 

DO 25 1=1, NTAR 
NSTA=NST(I ) 

WRITE(6,63) (I , J, JSET( I , J ) , J= 1 , NSTA ) 

25 CONTINUE 
C 

C SUBROUTINE TO CHECK MONTE CARLO SIMULATION ACCURACY IN 
C THE ABSENCE OF RANDOM NOISE CONTAMINATION OF EMITTER 
C BEARING ANGLES 
C 

IF(V.EQ.O.O) GO TO 23 
GO TO 24 

23 WRITE(6,46) 

DO 26 1=1, NTAR 
NSTA=NST(I ) 

KI=JSET( I, 1) 

KF=JSET( I ,NSTA1 
THTDK KF)=BRNGD( KI ) 

THTD(KF)=BRNGD(KF) 

26 CONTINUE 
GO TO 29 

C 

C PROGRAM TO FILTER NOISY MEASURED BEARING ANGLE THETAD(K) 
C AND AIRCRAFT NAVIGATION DATA FOR EACH SUSPECTED EMITTER 
C TARGET OF SIMILAR FREQUENCY AND PRF 
C 

C INITIALIZATION OF KALMAN FILTER EQUATION PARAMETERS 
C 

24 WRITE(6,50) 

DO 20 1=1, NTAR 
KI=JSET( 1,1) 

PIKKI ) = 100.0 
P12! KI )=0. 0 
P22(KI ) = 100.0 
QIK KI )=0.0 
Q12(KI )=0.0 
Q22(KI )=0.0 
Dll! KI ) =1.0 
D12(KI )=0.0 
021! KI J=0.0 
D22(KI )=1.0 
R ( K I ) = 1 . 0 

G1 (KI)=P11(KI )/( PIKKI )+R(KI ) ) 

G2(KI ) = P12(KI )/ (PIKKI ) + R(KI ) ) 

THTDIKI )=THETAD(KI ) 
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THTDl (KI )=THETAD(KI ) 

T0TD(KI )=VEL{KI)*SIN{RB(KI ) )/500000.0 
TDTDKKI )=TDTD{KI ) 

T(KI )=0.0 
K2 = 0 
K3=l 

WRITE(6,6A)I ,K3, K2,KI ,G1(K I ) ,G2( KI ) ,T{ KI) 

START OF KALMAN FILTER PREDICTION PROBLEM 

NSTA=NST(I) 

DO 21 J=2,NSTA 
22 K=JSET(I,J) 

KK=JSET{ I , J-1) 

TKM1=TIMET(KK) 

T(K)=TIMET(K)-TKM1 
TT{K)=T(K)/1000.0 
Qll{K)=TT{K)>^-*4/4.0 
Q12{K)=TT(K)=^’!‘3/2.0 
Q22(K)^TT( K)*>!=2 
R(K) = 1 .0 

START OF KALMAN FILTER RECURSION EQUATIONS 

Pll (K)=P1L (KK) 1 .0-Gl (KK) ) +2.0=?=P12 { KK ) ^^‘T { K )- ( P 12 { KK ) * 
1G1(KKH-P11IKK)*G2{ KK) )*T (KH-{P22 IKK) -P12 { KK) *G2 (KK ) 
2T{K)*=^2+Q11(K) 

P12 ( K) =P12 {KK)»{ 1.0-Gl (KK) )+{P22 IKK )-P 12 ( KK ) ^G2 ( KK ) )* 
1T{K)+Q12(K) 

P22{K)=P22{KK)-P12{KK)*G2(KK)+Q22( K) 

G1{K)=P11 IK)/ {P11(K)+R(K) ) 

G2{K)=P12{K)/(P11(K)+R{K)) 

TPTO(K)=THTD{KK)+TDTD(KK)*T(K) 

E( K) =THETAD{ K)-TPTO(K) 

THTDl K)=TPTD IK ) +G1 (K)=!'E{K) 

TDTD(K) =TDTD(KK)+G2(K I’i^EIK ) 

SMOOTHING EQUATIONS FOR FIRST BEARING LINE ESTIMATE 

PIN! 1 , 1 )=P11 (K) 

PIN! 1,2)=P12IK) 

PINI2, 1)=P12{K) 

PINI2 ,2)=P22 IK) 

CALL MINVI PIN,2,DET,LW,MW) 

PIN11(KJ=PIN(1,1) 

PIN12I K) =PIN(1 ,2) 

PIN22(K)=PIN( 2,2) 

QPll IK ) = Q11{K) =:=P INll (K )+Q12(K)*P IN12IK ) 
QP12IK)=Q11(K)*PIN12(K)+Q12{K)*PIN22 IK) 

QP2KK ) = Q12(K)-PIN11(K ) + Q22 ( K ) =:=P IN 12 { K ) 

QP22 (K )=Q12IK) *PIM12{K )+Q22(K)*PIN22{K) 
D11{K)=D11{KK)*{ 1.0-QPllIK) )-D12 ( KK ) =^Q P2 1 I K ) +01 1 { KK ) * 
1QP21 (K )=M(K) 

D12IK) =D12 {KK)=!=( 1 . 0 -QP22 { K ) ) -D 1 1 { KK ) *QP 1 2 ( K ) +D1 1 { KK ) * 
1(QP22{ K)“1.0)’i'T( K) 

D21 { K) =D21 IKK)*{ 1.0-QPllIK ) )-02 2 I KK ) *QP2 1 ( K)+D21( KK)* 
1QP21(K)=!'T{K) 

D22(K)=022(KK) *( 1. 0-QP22IK) )-D21 (KK) *QP12 { K ) +D21 ( KK) * 
1{QP22(K)-1.0)*T{K) 

THTDU K) =THT01 IKK) + 1011 { K ) *G1 I K ) +D 12 { K ) *G2 ( K ) ) =^=E { K ) 
TDTD1IK)=TDTD1 (KK)+{D21(K)*G1(K)+D22{K)#G2(K) )*E(K) 

CORRELATION GATING SCHEME TO ESTIMATE WHETHER FILTERED 
BEARING ANGLE THTOIK) IS AN EMISSION FROM EMITTER TARGET 
NTAR = I OR A SPURIOUS EMISSION 

GATE {K)=3.0*S0RT (Pll IK)+R{K) ) 

WRITE(6,65 ) I , J ,KK, K, G1 (K ) ,G2(K ) , T( K) ,EIK) tGATEI K) 
1F(A3S(E(K)).LT.GATE(K)) GO TO 21 

THTDIK) IS A SPURIOUS BEARING LINE AND IS DISCARDED 
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28 NST( I)=NST(I )-l 
NSTA = NST ( I ) 

IF(NSTA.LT.J) GO TO 20 
DO 27 L=J,NSTA 
JSETd ,L)=JSET(I,L + 1) 

27 CONTINUE 
GO TO 22 
C 

21 CONTINUE 

FILTERED BEARING ANGLE THTD(K) IS CORRELATED TO EMITTER 
TARGET NTAR = I 

20 CONTINUE 

SUBROUTINE TO COMPUTE FINAL EMITTER TARGET JSET DATA 

WRITE(6,66) 

DO 30 1=1, NTAR 
NSTA=NST( I } 

WRITE(6,63)(I,J,JSET(I,J),J=1,NSTA) 

30 CONTINUE 

PROGRAM TO COMPUTE TARGET POSITION BASED ON A PLANE 
TRIANGULATION SOLUTION 

29 DO 35 1=1, NTAR 
WR1TE(6,59) I 
WRITE! 6,67) I 
NSTA=NST(I) 

KI=JSET( I ,1) 

KF=JSET( I ,NSTA) 

DO 34 J=1,NSTA 
K=JSET( I , J) 

WRITE(6,60)K,FREQ( K) ,PRF(K) ,PW(K) , TH ET AD ( K ) , THTD ( K ) , 
ITHTOl (K) 

34 CONTINUE 

THTIKF )=THTD(KF) /PIRAD 

THTl (KF)=THTD1 (KF) /P IRAD 

TATI I ) =TAN(THT1 (KF) ) -TAN (THT (KF ) ) 

WAVII ) = (SLA(KI ) + SLA(KF ) ) /2.0 

TILAI I ) = ( ( SLG(KF)-SLO(KI ) ) ^=COS (WAV! I ) ) +SLAIKI)* 

ITANI THTl IKF) ) - SLA ( KF ) =:=TAN I THT ( KF ) ) )/TAT( I) 

TLAI I ) = ( I SLO(KF)-SLOIKI ) ) ^i'CCS ( T I LA ( I ) )+SLA(KI )* 

ITANI THTl (KF ) )-SL A I KF ) *T AN I THT I K F ) ) )/TAT( I) 

TLADI I ) = TLA( I ) *PIRAD 

TLOI I )=SLO(KF)+ITLA( I )-SLA(KF) ) *TANI THTl KF ) ) / 
ICOSITILAII )) 

TLODI I )=TLOI I ) *PIRAD 
WRITEI6,68)THTD1(KF) , THTD IKF) 

WRITE16,70) TLADI I ) ,TLODI I ) 

C 

35 CONTINUE 
C 

46 FORMAT! *0 THIS MONTE CARLO SIMULATION HAS NO EMITTER', 
1« BEARING ANGLE MEASUREMENT NOISE',//,' EXECUTE A ', 
2'CALIBRATION CHECK FOR SIMULATION ACCURACY IN ABSENCE' 
3' OF RANDOM NOISE' ) 

48 FORMAT I ' 1' ,36X, 'LISTING OF EMITTER TARGET DATA AND ', 

I'AIRCRAFT NAVIGATION DAT A' ,///, 13X ,' TARGET PARAMETERS' 
2, 37X, 'AIRCRAFT PARAMETERS',//,' JSET TIMET FREQ ' 
3'PRF PW BRNGD V THETAD HOGD ' 

4'SLAD SLOD ALT VELN VELE',//) 

49 FORMAT!' ' , I 3, 2X , F 5. 1 , 2X , F6. 1 , 2X ,F 5. 1 , 2X ,F4. 2 ,2X , F9 . 5 , 
12X,F8.5,2X,F9.5,2X,F5.1,2X,F8.5,2X,F10.5,2X,3F7.1) 

50 FORMAT I ' 1' ,14X, ' LISTING OF KALMAN FILTER PARAMETERS', 

1//,' I J KK K GKK) G2IK) TIK) ', 

2' EIK) ' ,6X, 'GATE(K) ' ,/) 

51 F0RMATI7F11. 5) 

52 FORMAT (6F13. 5) 

57 FORMAT! *1 LISTING OF BEARING ANGLES-OF-ARR I VAL AND ', 
I'AIRCRAFT NAVIGATION DATA',///,' N HDGDIN) ', 
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59 

60 

61 

62 

63 

64 

65 

66 

67 

68 

70 



2'SLAD(N) SLOD(N) BRNGD(N) THETAD(N) THE TA ( N ) * , // ) 
FORMAT (• • ,I3,4F11.5,F10.5,F9.5) 

FORHAT( ' 1' ,28X,'NTAR =',I3,//) 

FORMAT (• • ,I3,2F8.1,F7.2,3F12.5) 

FORMATCO UNFILTERED EMITTER TARGET DATA INITIALLY 
I'ASSOCIATED TO NTAR ='tI3,//,' EMITTER BEARING LINES', 
?.' OF SIMILAR FREQUENCY AND PRF OR PRF MULTIPLE',////, 
3’ NUM FREQ PRF PW HDGD BRNGO' , 

4' THETAD',/) 

FORMATCl INITIAL JSET DATA',//) 

FORMAT! ' JSET( ',11, ',',12,')=', 13) 

FORMAT ( 'O' ,4I3,4F10.5) 

FORMAT!' ' ,4I3,4F10.5,F12.5) 

FORMAT! '1 FINAL JSET DATA',//) 

FORMAT ( 'OFILTERED AND SMOOTHED EMITTER TARGET DATA ', 
I'CORRELATED TO NTAR =',I2,///,' NUM FREQ PRF', 

2' PW THETAD THTD THTDl',/) 

FORMAT !' O' ,//, ' SMOOTHED INITIAL BEARING ANGLE =', 
1F10.5,//,' FILTERED FINAL BEARING ANGLE =',F10.5//) 
FORMAT! '0 PLANE TR I ANGUL AT I ON SOLUTION OF EMITTER ', 

1' LOCATION' ,//, ' EMITTER LATITUDE =',F10.5,'N' 

2//,' EMITTER LONGITUDE =',F10.5,'W') 

STOP 

END 
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C ^ 

C =!< EXTENDED KALMAN FILTER COMPUTER SUBROUTINE 

C =»= 

c 

C EMITTER LOCATION SOLUTION USING EXTENDED KALMAN 
C FILTERING TECHNIQUES 

C EXTENDED KALMAN FILTER INITIALIZATION 
C 

DO 20 I=1,NTAR 
KI = JSET{ I, 1) 

Pll (KI )=2 .0 
P12(KI )=0.5 
P22(KI )=1.0 
R(KI ) = 1 .0 

XTDIKI )=-117. 42503 
YTDIKI )=33. 24187 
XT(KI)=XTD(KI)/PIRAD 
YT{KI)=YTD(KI) /PIRAD 
ATl=(XT(Kn-SLO(KI ) 3*C0S(YT(KI ) ) 

AT2=YT(KI)-SLA{KI) 

TX(KIJ=ATAN2(ATi,AT2) 

ER{Kn=THETA(KI)-TX(Kn 

DM=(YTD(KI)-SLAD(KI) ) **2+( XTD ( KI ) -S LOD ( K I ) )*«2 
l*(COS(YT(Kin )-*2 

DMXIKI ) = (YTD(KI )-SLAD(KI ) ) *C0S ( YT( KI )J /DM 
DMYIKI )=-(XTD( KI )-SL00(KI ) J-M (YTD( KI ) -S L AD ( K I ) ) * 
ISINIYT (KI ) I+COS (YT(KI ) ) ) /DM 
DG = P11 (KI I^i'DMXIKI )=f^*2 + 2.0=!^P12(KI )=«=DMX(KI )*DMY(KI) 
1+P22(KI)*DMY(KI)**2+R(KI ) 

GX(KI ) = (P11(KI 3"^DMX(KI ) + P12(KI )>^DMY(KI ) ) /DG 
GY(KI ) = ( PI 2(KI)=^ DMXIKI )+P22(KI 3^^ DMYIKI ) 3/DG 

START OF KALMAN FILTER PREDICTION PROBLEM 

NSTA=NST(I 3 
DO 21 J=2,NSTA 
22 K=JSET(I,J3 

KK=JSET( I , J-13 
Q11(K3=0.10 
Q12(K3=0.0 
Q22IK3 =0. 10 
R(K3=1.0 

START OF EXTENDED KALMAN FILTER RECURSION EQUATIONS 

Pll (K3 = P11 (KK3 *( 1.0-GX (KK3 *DMX(KK3 3-P12 ( KK 3 *GX( KK 3 * 
1DMY(KK3+Q11(K3 

P12(K3=P12(KK3 -( 1.0-GXIKK3 *DMX(KK3 3-P22I KK 3 -GX( KK3 * 
1DMY(KK3+Q12(K3 

P22IK 3 = P22(KK3=i-'( 1. O^-GYI KK3 =!^DMY( KK3 3 -P12 ( KK 3 *GY ( KK 3 * 
IDMXIKK 3+Q22IK3 

DM=(YTD(KK3-SLAD(K5 3 **2+ ( XT D( KK 3 -S LOD ( K 3 3 **2 
1*(C0S( YTIKK 3 3 3 **2 

DMX(K3 = (YTD(KK3-SLAD(K3 3*C0S (YTIKK 3 3 /DM 
DMY(K3=-(XTO(KK3-SLOD(K3 3 * ( ( YTD ( KK 3 -S L AD ( K 3 3 * 

IS IN (YTIKK 3 3+COS(YT(KK 3 3 3 /DM 
DG=P11 (K3*DMX( K3 **2+2.0 *P12(K3*DMX (K 3*DMY( K 3 + 
1P22(K3*DHY(K3**2+R(K3 
GX(K3=(P11(K3*DMX(K3+P12(K3*DMY(K3 3/DG 
GY(K3 = (P12(K3*DMX(K3+P22(K3*DMY(K3 3/DG 
AT1=(XT(KK3-SL0(K3 3*COS(YT(KK3 3 
AT2=YT (KK3-SLAIK3 
TX(K3=ATAN2( ATI ,AT23 
ER(K3 = THETA(K3-TX(K3 
XTD(K3=XTD(KK3+GX(K3*ER(K3 
YTDIK3 =YTD(KK3+GY( K3*ER(K3 
XT(K 3=XTO(K3 /PIRAD 
YT (K3=YTD(K3/PIRAD 
21 CONTINUE 
20 CONTINUE 
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